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SUMMARY 


The  primary  results  of  the  research  efforts  are  the  following: 

1.  Development  of  an  approach  for  real  time  on-board  estimation  of 
spacecraft  orientation  with  sub  five  arc-second  precision. 

2.  Detailed  formulation  of  an  efficient  and  reliable  star  pattern 
recognition  strategy  appropriate  for  use  with  charged-coupled- 
device  (CCD)  array-type  star  sensors. 

3.  Formulation  of  a  motion  integration/Kalman  filter  algorithm  to 
integrate  gyro  measured  angular  rates  and  (by  sequential  processing 
of  the  discrete  orientation  information  available  from  the  star 
sensing,  identification,  and  attitude  determination  process) 
provide  optimal  real  time  estimates  of  spacecraft  orientation  and 
angular  velocity. 

4.  Development  of  truth  models  to  generate  realistic  input  data  for 
the  star  pattern  recognition  and  Kalman  filter  strategies. 

5.  Formulation  of  algorithms  using  Euler  parameters  to  define  orien¬ 
tation. 

6.  Implementation  and  validation  of  the  approach  in  a  laboratory 
microcomputer  -  the  objective  being  to  assess  the  problems  asso¬ 
ciated  with  a  real-time,  on-board  version  of  this  system. 


These  results  are  discussed  in  detail  herein.  This  report  is 
organized  in  such  a  fashion  that  the  key  features  and  results  of  the 
work  are  discussed  in  the  main  body  of  the  text;  the  more  involved  and 
technical  details  are  documented  in  the  ten  appendices. 
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1.0  Introduction 


This  document  reports  the  findings  of  a  three  year  research  project 
to  develop  a  method  for  on-board  satellite  attitude  determination.  We 
believe  this  method  can  achieve  sub-five-arcsecond  accuracy  when  applied 
to  data  obtained  with  a  new  general  purpose  star  tracker  (typical  of 
several  existing  configurations). 

The  primary  motivation  for  the  research  is  the  exploitation  of 
recently  developed  light  sensitive  Charge-Coupled-Devices  (CCD)  arrays, 
placed  in  the  focal  plane  of  a  tracker  lens,  to  act  as  a  "film"  for 
imaging  starlight.  Satellite  attitude  can  be  determined  by  identifying 
the  stars  detected  by  the  CCD.  The  star  image  data,  output  from  the 
CCD,  can  be  either  telemetered  to  ground  for  later  analysis  or,  as 
described  in  this  report,  analyzed  on-board  (via  computers  configured  in 
parallel)  to  determine  satellite  attitude  autonomously  in  near  real-time. 

The  basic  system  we  propose  consists  of  2  or  3  CCD  star  trackers 
and  3  microcomputers,  each  with  a  dedicated  function.  The  function  of 
each  of  the  4  sub-systems  is  outlined  below,  with  reference  to  Figures 
1.1,  1.2,  and  1.3. 

1.1  System  Overview 

(1)  CCD  Star  Sensors  and  Associated  Electronics 

Although  the  development  of  CCD  sensors  and  trackers  is  not 
part  of  this  research,  there  are  several  CCD  star  tracker  designs 
proposed  by  various  organizations  involved  in  hardware  development. 
The  purpose  of  our  work  has  been  exploitation  of  the  CCD  star 
tracker  technology;  we  have  chosen  a  particular  set  of  parameters 


Figure  1.1  UVASTAR  An  electro-optlcal/software  system  capable 
of  real  time  readout  of  digitized  star  coordinates, 
and  ultimately,  autonomous,  near-real  time  star 
pattern  recognition  and  attitude  determination. 
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but  it  should  be  kept  in  mind  that  these  are  nominal,  achievable 
values  without  further  CCD/star  tracker  technology  advances.  Each 
of  the  two  (or  three)  trackers  is  identical  and  their  boresights 
are  assumed  separated  by  the  nominal  interlock  angle  of  90°.  We 
assume  a  lens  focal  length  of  70  mm  and  a  CCD  array  size  such  that 
a  7°  X  9°  field  of  view  (FOV)  is  imaged  onto  the  array.  The  arrays 
are  assumed  to  be  Fairchild's  11.4  mm  x  8.8  mm  matrix  consisting  of 
488  X  380  silicon  pixels,  each  pixel  accurately  imbedded  (to  1  part 
in  10,000)  in  a  microcircuit  chip.  Starlight  is  defocused  slightly 
on  the  CCD  in  order  to  spread  typical  images  over  9  to  16  neigh¬ 
boring  pixels.  This  permits  accurate  "centroiding"  of  the  image  to 
determine  image  coordinates  accurate  to  about  10%  of  a  pixel 
(10%  is  a  conservative  estimate).  The  processing  of  a  data  frame 
consists  of  a  rapid  sequential  readout  of  the  voltage  response  of 
all  pixels  and  an  analog  to  digital  (A/D)  conversion  only  of  cer¬ 
tain  pixels  (based  upon  response  above  an  analog  threshold  level  or 
prior  selection).  The  scans  of  each  field  of  view  are  controlled 
by  a  common  clock  and  are  assumed  to  represent  2  (or  3)  frames  (1 
from  each  sensor)  taken  at  the  same  instant.  This  assumption  is 
valid  for  all  but  very  rapidly  spinning  satellites,  since  the  CCDs 
can  be  scanned  10  times  per  second.  (Refer  to  Appendix  1  for  more 
star  tracker  information.) 

(2)  Microcomputer  A 

Program  Pfiocu-i  A  is  performed  by  a  Microcomputer  A  with 
either  one  computer  per  sensor  or  sequential  treatment  of  data  for 
2  or  3  sensors.  Again,  Process  A  is  not  part  of  this  research 
program  but  since  the  functions  to  be  performed  are  straightforward, 
we  simply  replace  Process  A  by  calculating  synthetic  output  data 


whose  availability  is  clock  controlled.  Process  A  takes  as  input 
data  the  digitized  pixel  voltages  and  pixel  coordinates  for  up  to 
10  stars  in  each  FOV  and  the  associated  time.  Image  centroids  are 
calculated  for  each  image  and  corrections  for  lens  distortion  and 
other  known  error  sources  are  applied;  a  relative  magnitude  or 
intensity  is  also  calculated.  As  output.  Process  A  delivers  the 
focal  plane  coordinates  for  each  star  image.  Since  Process  A 
calculations  for  one  data  frame  can  be  performed  in  near  real  time 
and  many  times  faster  than  the  attitude  can  be  determined,  it  may 
be  possible  and  desirable  to  perform  additional  editing  of  the  star 
data.  For  example,  images  with  rapidly  varying  image  intensity 
from  frame  to  frame  could  be  eliminated  or  images  whose  successive 
positions  are  inconsistent  with  the  overall  motion  caused  by 
vehicle  motion  (such  as  images  of  space  debris)  could  be  deleted 
immediately  from  consideration  (failure  to  detect  and  delete  all 
spurious  images  does  not  prove  fatal,  but  does  slow  the  pattern 
recognition  logic  of  Process  B).  Process  A  would  be  expected  to 
output  image  coordinate  and  magnitude  data  at  the  rate  of  about  5 
frames  per  sensor  each  minute  and  simply  overwrite  old  data.  The 
microcomputer  of  Process  A  is  considered  as  an  integral  part  of  the 
star  tracker  itself,  making  it  a  "smart  sensor". 

Since  Process  A  controls  the  scan  of  the  CCD  and  its  electronics, 
it  is  possible  to  track  only  those  stars  desired  (those  whose  pixel 
response  lies  within  specified  bounds).  Thus,  even  though  the  CCD 
array  contains  thousands  of  pixels,  only  a  small  fraction  of  their 
response  values  need  be  subjected  to  A/D  conversion  and  stored  at 
any  one  time.  It  is  this  data  compaction  feature,’  along  with  the 


high  dimensional  stability  of  CCD  arrays  that  make  them  so  attractive 
for  this  application.  Also  significant  is  the  high  speed  readout 
of  the  CCD  which  allows  one  to  assume,  for  most  cases,  that  the 
star  images  visible  in  a  given  frame  have  been  imaged  simultaneously. 
Therefore,  stellar  resection  (geometric)  methods  can  be  used  for 
attitude  determination  and  the  vehicle  motion  can  be  ignored  for 
anaylsis  of  a  single  frame  of  data. 

(3)  Microcomputer  B 

Data  from  Process  A  (and  Process  C)  are  analyzed  by  program 
PfLOceM  B;  again  by  means  of  a  dedicated  microcomputer.  As  input. 
Process  B  accepts: 

•  star  image  coordinates  and  magnitude  data;  one  set  per  FOV 
(from  Process  A); 

•  a-priori  attitude  estimates  and  covariance,  (from  Process  C); 
and 

•  a-priori  estimates  and  covariance  of  interlock  angles  between 
the  sensors  image  planes  (from  previous  analysis  of  Process  B 
data) . 

The  sequence  of  calculations/logical  decisions  divides  into 
two  primary  functions: 

•  identify  measured  stars  in  each  FOV  as  specific  stars  contained 
in  an  on-board  star  catalog  (containing,  in  the  general  case, 
the  direction  cosines  and  instrument  magnitudes  of  the  5000 
brightest  stars)  and 

•  determine  the  spacecraft  orientation  and  field  of  view  inter¬ 
lock  angles  which  cause  the  simulated  images  of  identified 
catalog  stars  to  overlay  the  corresponding  measured  images  in  a 
least-squares  sense. 


These  two  tasks  will  be  discussed  in  detail  in  Section  3  and 


appendices.  The  expected  output  rate  for  Process  B  is  two  or  more 
attitude  updates  per  minute  of  elapsed  time.  The  old  attitude  and 
covariance,  output  to  Process  C,  are  overwritten  by  each  new 
attitude  and  covariance. 

(4)  Microcomputer  C 

The  attitude  determined  by  Process  B  for  a  discrete  time  is 
further  processed  by  program  Pvoaess  C  in  microcomputer  C.  Input 
to  this  program  consists  of  the  attitude  and  covariance  from  Process 
B  and  A/D  converted  gyro  rate  measurements  of  angular  velocity. 

The  kinematic  differential  equations  governing  the  spacecraft 
attitude  are  integrated  forward  from  the  attitude  determined  from 
the  previous  pass  through  Process  C  (using  the  gyro  rate  measurements). 
This  yields  an  attitude  estimate  at  the  time  associated  with  the 
next  set  of  image  coordinates  from  Process  A.  After  Process  B  has 
determined  the  discrete  attitude  it  is  combined  with  the  integrated 
attitude  in  a  Kalman  Filter  calculation  to  give  a  best  estimate  of 
attitude  at  the  time  associated  with  the  star  tracker  data. 

Further  forward  integration  gives  an  estimated  attitude  and  co- 
variance  at  real-time. 

1.2  Focus  of  This  Study 

Our  primary  tasks  were  to  develop  the  algorithms  for  Process  B 
(star  pattern  recognition  and  attitude  determination),  and  Process  C 
(state  integration  and  Kalman  filter  routines).  This,  of  course,  required 
some  study  of  CCD  arrays  and  star  tracker  design  (Process  A).  A  gov¬ 
erning  principle  was  that  this  system  be  suitable  for  a  general  purpose 
satellite;  that  is,  we  did  not  design  it  with  a  particular  mission  in 


9 


1 


I 

I 

I 

I 

I 

I 

1 

1 

1 

I 


f 


I 

1 

1 

I 

1 

I 

1 

I 


mind.  We  have  required  a  slowly  rotating  satellite,  however,  in  order 
to  insure  that  star  images  do  not  cause  streaks  in  the  star  camera  and 
that  our  rate  integration  be  valid  (i.e.,  the  vehicle  not  undergo  rapid 
maneuvers). 

The  algorithms  we  devised  can  run  on  a  large  memory  (64,000  bytes), 
general  purpose  microcomputer.  To  demonstrate  this,  we  have  programed 
the  algorithms  on  a  Hewlett-Packard  9845S  microcomputer  equipped  with  a 
high  level  BASIC  interpreter  language  package.  Although  the  processing 
time  with  this  language  is  significantly  slower  than  a  compiler  type  of 
system  or  machine  code  program  its  use  permitted  programming  ease,  which 
was  essential  for  development  work.  Our  tests  show  the  present  system 
will  produce  updated  attitude  estimates  every  60  seconds  (with  rate 
integrated  attitude  available  several  times  per  second)  in  a  steady 
state  mode;  when  the  programs  are  implemented  in  a  form  suitable  for  a 
satellite  computer  they  should  execute  much  faster. 

We  have  organized  this  report  to  include  most  of  the  detail  and 
mathematical  developments  in  appendices  in  order  to  keep  the  body  des¬ 
criptive  and  concise.  Section  2  discusses  the  coordinate  frames  and 
orientation  variables  used  in  this  study.  Processes  B  and  C  are 
described  in  Sections  3  and  4,  respectively.  We  discuss  our  truth  model 
and  simulation  tests  of  our  algorithms  in  Section  5  and  present  con¬ 
clusions  in  Section  6.  The  reader  is  referred  to  references  1-3  for  a 
discussion  of  intermediate  results  of  this  project. 
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2.0  Orientation  Parameters  and  Coordinate  Frames 

In  order  to  describe  the  orientation  of  a  spacecraft  we  need  to 
specify  some  coordinate  frame  fixed  in  the  vehicle  and  another  fixed  in 
inertial  space.  In  addition,  we  need  a  parameter  set  to  describe  the 
relative  orientation  of  these  two  frames. 

Euler  angles  provide  an  easily  understood  description  of  relative 
orientation  of  two  frames.  The  three  angles  specify  a  sequence  of 
rotations  about  three  successive  coordinate  axes  of  a  rotated  frame. 
However,  although  they  are  descriptive,  Euler  angles  are  not  very 
suitable  for  our  purposes  for  several  reasons.  Any  of  the  twelve 
possible  rotation  sequences  possesses  two  singularities.  In  addition, 
the  differential  equations  describing  the  rotational  motion  of  a  vehicle 
involve  trigonometric  nonlinearities  when  expressed  in  terms  of  Euler 
angles.  The  same  is  true  of  the  least-squares  equations  used  in  the 
star  pattern  recognition  algorithms.  Extensive  use  of  trigonometric 
functions  will  significantly  increase  the  computation  time. 

2.1  Euler  Parameters 

These  problems  have  been  circumvented  by  using  a  set  of  four 
variables  called  Euler  parameters  instead  of  Euler  angles.  Euler  param¬ 
eters  have  the  advantages  that  (1)  they  do  not  have  a  geometric  singu¬ 
larity,  (2)  they  rigorously  satisfy  linear  differential  equations,  and 
(3)  no  evaluation  of  trigonometric  functions  need  be  done  in  any  applica¬ 
tion  discussed  herein.  One  disadvantage  is  the  four  parameters  must 
sum-square  to  unity;  we  have  found  methods  to  include  this  constraint  in 
our  estimation  algorithms. 

Euler  parameters  (Bo,  Bi,  B2,  Bs)  can  be  interpreted  geometrically 
in  terms  of  Euler's  theorem:  A  completely  general  angular  displacement 


of  a  rigid  body  can  be  accomplished  by  a  single  rotation  (the  principal 
angle,  4))  about  a  line  (the  principal  line,  l)  which  is  fixed  relative 
to  both  arbitrary  body-fixed  axes  {b}  and  reference  axes  {n}.  If  {n} 
is  initially  conincident  with  {b},  then  the  direction  cosines  {11,12,1^3) 
of  I  with  respect  to  {n}  and  {b}  are  identical. 

The  Euler  parameters  are  then  related  to  the  principal  rotation 
parameters  as  follows: 

&o  =  cos  <{)/2 

(2.1) 

3^-  =  sin  4>/2,  i  =  1,2,3. 


Note  that  Euler  parameters  satisfy  the  constraint: 

3 

I  3?  =  1.  (2.2) 

i=0 

The  rotation  matrix  [C]  characterizing  the  relationship  between  a  body 

A  ^  /V  A 

fixed  frame  {b}  and  a  reference  frame  {n}  by:  {b}  =  [C]{n}  can  be 
written  in  terms  of  Euler  parameters  as: 

3S  +  3?  -  3l  -  Bl  2(Bi32  +  3o33)  2(3i33  -  30B2) 

[C]  =  2(3i32  -  Bo33)  3o  -  3!  +  3l  -  3l  2(3233  +  3o3i) 

2(3i33  +  3o32)  2(3233  -  3o3i)  3o  -  3?  -  3l  +  3? 

(2.3) 

2.2  Coordinate  Frames 

For  convenience  we  have  used  several  coordinate  frames  for  Process 
B  and  C  algorithms.  They  are:  the  inertial  frame,  N,  the  gyroscope 
frame,  G,  the  vehicle  frame,  V,  and  two  camera  frames,  A  and  B  (Table 
2.1). 

The  inertial  frame  is  our  primary  reference  frame  and  is  defined, 
essentially,  by  star  positions.  The  locations  of  all  the  stars  in  the 


12 


Table  2.1 
COORDINATE  FRAMES 

Inertial  Frame  (N):  Primary  reference  frame.  Used  for  star 

positions  and  vehicle  velocity  components. 

Gyroscope  Frame  (G):  Defined  by  orientation  of  three  orthogonal 

gyroscopes.  Rotation  rate  of  the  vehicle 
is  measured  in  this  frame. 

Camera  "A"  Frame  (A):  Defined  by  orientation  of  camera  boresight 

and  focal  plane. 

Camera  "B"  Frame  (B);  Defined  by  orientation  of  camera  boresight 

and  focal  plane. 

Vehicle  Frame  (V):  Defined  by  boresight  unit  vectors  of  the 

"A"  and  "B"  frames.  Orientation  of  this 
frame  with  respect  to  the  "N"  frame  is 
determined  by  Process  B. 

RELATIONSHIPS  BETWEEN  FRAMES 

G  -  N:  Changes  as  vehicle  rotates. 

V  -  N:  Changes  as  vehicle  rotates. 

V  -  G:  Assume  this  varies  slowly  with  time.  Gyro  bias  terms  compen¬ 

sate  for  small,  slow  variations. 

B  -  A:  Assume  this  varies  slowly  with  time.  Interlock  parameters  are 
monitored  by  Process  B. 


onboard  catalog  are  specified  in  this  frame,  as  are  the  vehicle  velocity 
components  (used  for  aberration  corrections).  The  gyro  frame  is  defined 
by  the  axes  of  three  orthogonal  gyroscopes,  fixed  in  the  vehicle.  Each 
gyroscope  gives  a  measure  of  the  vehicle  rotation  rate  about  that  axis 
(these  are  the  rates  integrated  by  Process  C).  Our  simulation  studies 
have  been  configured  for  a  nominally  earth  pointing  spacecraft.  Accordingly, 
we  have  specified  that  the  unit  vectors  {g^}  along  the  gyro  axes  be 
oriented  such  that  ga  is  along  the  radius  vector,  ga  is  perpendicular  to 
the  orbit  plane  and  then  gi  =  ga  gs  (nominally  along  the  velocity  vector). 

The  two  camera  frames,  A  and  B,  are  assumed  fixed  to  the  vehicle 
and,  therefore,  maintain  a  fixed  orientation  with  respect  to  the  gyro 
frame.  We  have  specified  that  ^3  and  bs  coincide  with  the  camera  bore- 
sights  and  point  45°  from  the  direction  of  vehicle  motion,  above  and 
below  the  orbit  plane.  Unit  vectors  and  ^1  lie  along  the  x  axis  of 
the  CCD  of  each  camera  and  lie  in  the  orbit  plane  while  a^z  and  bz 
form  the  y  axis  of  each  CCD. 

The  V  frame  has  been  defined  by  the  boresight  vectors,  3$  and  ba 
(see  Figure  2.2): 

Vi  =  (as  +  b3)/la3  +  bal 

v^z  =  V 3  X  vi  (2.1 ) 

V3  =  (33  X  b3)/|a3  X  bal  . 

Both  Processes  B  and  C  have  been  formulated  to  employ  the  Euler  para¬ 
meters  which  orient  this  vehicle  frame  with  respect  to  the  inertial 
frame. 

There  are  several  advantages  to  this  definition  of  the  V  frame. 

First,  the  boresight  vector  of  each  frame  is  well  determined  compared 


Figure  2.1.  Relationship  of  the  vehicle  frame  to  FOV(A)  and 
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with  the  rotation  about  the  boresight  vector.  Thus,  the  V  frame  orien¬ 
tation  is  not  affected  by  the  poorly  known  quantities.  Second,  by  using 
this  definition  we  weight  frames  A  and  B  equally. 

Although  frames  G,  A  and  B  are  nominally  fixed  with  respect  to  the 
vehicle,  in  reality  these  intejitock  relative  orientations  will  vary  due 
to  thermal  cycling,  vehicle  vibrations,  etc.  Therefore,  we  have  included 
techniques  in  Processes  B  and  C,  to  be  discussed  in  later  sections,  to 
monitor  and/or  partially  correct  for  these  interlock  variation  effects. 

A  by-product  is  the  attractive  feature  that  the  system  becomes  fully 
self-cali bra ting. 


t 
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3.0  Process  B 

Attitude  determination  by  processing  image  coordinates  obtained 
from  Process  A  depends  upon  the  ability  to  describe  mathematically  the 
location  of  a  star  image  on  the  CCD  image  plane,  given  its  direction  in 
space  and  the  orientation  of  the  star  tracker.  This  mapping,  a  function 
of  the  Euler  parameters  discussed  in  Section  2,  is  described  by  the 
stellar  colinearity  equations  which,  for  frame  A,  have  the  form: 

LjANii  L2AN12  L3AN13 

X  =  f  - + 

L1AN31  +  L2AN32  +  L3AN33  ° 

(3.1) 

L1AN21  L2AN22  L3AN23 

y  =  f  - +  y 

LiANji  +  L2AN32  +  L3AN33  ° 

where  f  =  lens  focal  length,  assumed  to  be  constant, 

AN..  =  elements  of  the  coordinate  frame  rotation  matrix  AN, 

^  in  turn  a  function  of  Euler  parameters,  and 

L.  =  star  direction  cosines  for  the  particular  star  as 
measured  in  the  N  frame 

(Xo,yo)  =  principal  point  offsets. 

If  there  are  several  stars  in  a  single  field  of  view  (FOV)  we  seek 
to  minimize  the  sum  of  the  squares  of  the  residuals  between  measured 
star  images  and  predicted  coordinates  for  the  same  stars.  This  is 
accomplished  by  adjusting  the  Euler  parameters,  which  orient  the  star 
tracker  frame,  using  a  least-square  differential  correction  scheme. 

Before  outlining  the  least-square  procedures,  we  describe  the 
process  of  equating  particular  catalog  stars  with  measured  stars.  To 
start  Process  B  we  need  an  estimate  of  the  camera  orientation.  This  can 
be  provided  by  either  the  results  of  a  previous  pass  through  Processes  B 
and  C  or  from  some  indirect  method  such  as  horizon  sensors.  This 
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estimate  is  needed  to  acquire  a  "sub-catalog"  from  the  mission  catalog 
and  must  be  sufficiently  accurate  so  that  the  subcatalog  contains  the 
measured  stars. 

3.1  Star  Catalog 

As  part  of  our  work  on  Process  B,  we  have  converted  the  visual 
magnitude  of  over  5,000  stars  to  a  standard  infra-red  (I)  magnitude. 

For  simplicity,  we  assumed  the  instrument  magnitude  is  identical  to 
the  I  magnitude  (which  could  be  arranged  by  using  an  I  filter).  In 
specific  applications  instrument  magnitude  would  probably  be  based 
upon  laboratory  calibration.  We  have  not  processed  the  star  positions 
nor  corrected  for  proper  motion  since  these  tasks  would  best  await  an 
actual  flight  test  of  the  system.  Details  of  magnitude  conversions 
are  discussed  in  Appendix  2. 

In  addition,  we  developed  a  star  catalog  format  for  easy  access. 

The  celestial  sphere  is  divided  into  cells  or  segments  in  an  orderly 
pattern  so  that  any  cell  can  be  accessed  easily  to  obtain  the  positions 
of  stars  contained  within.  It  is  important  to  keep  in  mind  that  our 
catalog  segmentation  and  access  logic  were  designed  for  a  general  mis¬ 
sion.  Simplified  catalogs  could  be  designed  for  specific  missions.  See 
Appendix  3  for  more  details  on  the  cell  structure  and  access  logic. 

3.2  Star  Pairing 

Associating  catalog  and  measured  stars  begins  by  sorting  catalog 
stars  by  angular  distance  off  the  apriori  estimated  FOV  boresight 
direction.  By  computing  the  vector  dot  product  of  each  star  with  the 
boresight  vector  we  have  a  suitable  measure  of  angular  distance  and  can 
sort  stars  according  to  this  parameter  (and  thereby  avoid  repetative 


angle  calculations  from  inverse  trigonometric  functions).  The  next  step 
is  to  compute  and  store  in  a  table,  the  cosine  of  the  interstar  angle 
for  all  possible  pairs  of  measured  stars.  We  then  pair  catalog  stars, 
beginning  with  stars  nearest  the  estimated  boresight,  compute  the  cosine 
of  the  interstar  angle,  and  then  compare  this  value  with  each  value  for 
the  measured  pairs  (refer  to  Appendix  4).  This  process  is  repeated 
until  either  a  match  is  found  to  within  some  tolerance  or  the  list  of 
catalog  stars  is  exhausted.  In  the  latter  case  we  start  over  with  fresh 
data  from  Process  A  and  a  new  estimate  of  orientation.  However,  if  a 
match  is  found,  we  tentatively  assume  the  catalog  pair  is  the  same  as 
the  measured  pair.  We  are  now  ready  to  adjust  the  estimated  orientation 
parameters  via  least-squares  correction  to  get  the  two  projected  catalog 
stars  to  overlay  the  two  measured  stars.  Because  of  the  relatively  high 
probability  of  finding  an  invalid  star  pair  match,  attitude  confirmation 
requires  additional  star  matches,  as  discussed  below.  We  must  also 
account  for  the  effect  of  stellar  aberration  on  the  star  direction 
cosines  (refer  to  Appendix  5). 

3.3  Least-Squares  Correction 

The  non-linear  relationship  between  the  Euler  parameters  and  star 
image  coordinates  requires  an  iterative  least-squares  correction  proce¬ 
dure  to  find  the  best  estimate  of  vehicle  orientation.  Basically,  at 
each  iteration  we  require  the  Euler  parameter  corrections  to  minimize: 

(AX  -  A  AB)^W(AX  -  A  Ag)  (3.2) 

where  AX  is  a  column  vector  of  x  and  y  coordinate  residuals  between  the 
measured  and  predicted  images  (using  the  current  values  for  the  orienta¬ 
tion  variables),  A  is  a  matrix  of  partial  derivatives  of  star  positions 
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(the  stellar  colinearity  equations)  with  respect  to  current  Euler  parameters, 

A3  is  the  correction  vector  to  be  added  to  the  current  parameters  and  W 
is  a  weight  matrix.  The  derivation  of  this  equation  is  found  in  Appendix 
6. 

Since  the  Euler  parameters  must  satisfy  a  constraint  equation,  it 
is  necessary  to  guarentee  that  the  corrected  Euler  parameters  also 
satisfy  this  constraint.  If  we  express  the  constraint  equation  as 

6^  3  =  1.  (3.3) 

then,  after  correcting  the  parameters,  the  corrections  A3  must  satisfy: 

(3  +  A3)^  (3  +  A3)  =  1.  (3.4) 

Expanding  to  first  order  we  have: 

3^  3  +  23^  A3  =  1  +  residual  (3.5) 

and  by  writing  this  as 

(1  -  3^3)  -  23^A3  =  residual  (3.6) 

we  can  append  1  -  3^3  to  the  AX  vector,  23^  to  the  A  matrix  and  A3  is 
again  the  correction  vector.  In  solving  Eq.  (3.2)  we  assign  a  large 
weight  to  this  constraint  equation  in  order  to  insure  that  it  is  satis¬ 
fied  (l.e.,  the  residual  will  be  essentially  zero). 

After  the  vector  of  Euler  parameters  has  been  found  by  iteration, 
it  is  necessary  to  confirm  whether  or  not  the  catalog  pair  is  indeed  the 
measured  pair  (i.e.,  whether  we  have  the  correct  orientation).  Each 
catalog  star  is  mathematically  projected  onto  the  focal  plane  and  tested 
to  see  if  it  lies  near  a  measured  star.  A  match  of  three  or  more  stars 
is  considered  a  positive  outcome;  a  match  of  only  two  stars  (most  likely 
the  initial  pair)  or  fewer  constitutes  failure  and  we  continue  with  star 

) 
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pair  matching  to  find  another  pair.  In  the  present  software  version  we 
accept  up  to  5  catalog  stars  which  match  measured  stars  in  one  FOV. 

The  star  pair  matching  and  confirmation  calculations  described 
above  are  performed  separately  for  each  FOV.  If  the  outcome  for  each 
FOV  is  positive,  we  have  up  to  5  measured  stars  from  each  FOV  with  their 
corresponding  catalog  positions.  All  of  these  stars  are  used  to  correct 
the  orientation  again  and,  in  addition,  to  correct  the  Euler  parameters 
defining  the  interlock  relationship  between  the  two  FOV.  We  again 
minimize: 

(AX  -  A  Ae)^W(AX  -  AAg). 

Now,  AX  contains  the  residuals  for  all  images,  the  A  matrix  contains 
partial  derivatives  with  respect  to  both  the  Euler  parameters  orienting 
the  vehicle  frame  and  those  orienting  frame  B  with  respect  to  A,  and  AB 
contains  corrections  to  these  same  Euler  parameters.  As  before,  we 
append  two  constraint  equations,  one  for  each  set  of  Euler  parameters, 
to  the  matrix  equation.  (Refer  to  Appendix  7  for  details  of  this  pro¬ 
cedure). 

This  method  yields  an  accurate  vector  compared  with  The 

Byi^  describe  the  orientation  of  the  vehicle  frame  which,  in  turn, 
is  determined  by  the  FOV  boresight  vectors,  both  usually  well  deter¬ 
mined.  On  the  other  hand,  the  Bg^  are  effected  by  the  relatively  poorer 
determination  of  the  roll  angle  about  the  boresight  vector  of  each  FOV. 
Therefore,  we  have  found  it  desirable  to  further  process  Bg^.  We  assume- 
the  true  Bg^  vary  slowly  (due  to  such  things  as  thermal  cycling)  and 
write: 

'  0  (3.7) 

and  then  combine  the  apriori  or  predicted  values  of  Bg^  (obtained  from  a 
previous  analysis)  with  the  calculated  values  of  Bg^  obtained  via 


least-squares.  The  two  vectors  of  3g^  are  combined  using  a  discrete 
Kalman  filter  (see  Appendix  6  for  details).  This  method  can  be  used, 
with  proper  tuning,  to  monitor  the  interlock  variations  and  give  the 
system  "memory"  of  past  interlock  determinations. 

We  note  that  the  least-squares  method  for  two  FOV  and  the  Kalman 
filter  calculations  involve  considerable  mathematics,  such  as  matrix 
multiplication  and  matrix  inversion,  which  adversely  affects  execution 
time.  However,  it  is  important,  we  feel,  to  provide  the  option  to 
calibrate  (as  often  as  necessary)  the  interlocks  between  camera  frames. 
By  monitoring  these  variations  we  can  make  the  system  self-calibrating 
and  can  tolerate  modest  lack  of  mechanical  stability  in  the  various 
interlocks. 
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4.0  Process  C 

Procsss  C  software  has  two  primary  functions:  (1)  integrate  the 
kinematic  differential  equations  describing  the  satellite  motion  over  a 
short  time  interval  in  order  to  provide  Process  B  with  a  new  attitude 
estimate,  and  (2)  combine  this  integrated  orientation  with  the  orien¬ 
tation  determined  by  least-squares  in  Process  B.  The  second  function  is 
performed  via  a  discrete  Kalman  filter  to  yield  an  optimal  estimate  of 
the  orientation  at  a  particular  time. 


4.1  Kinematic  Equations 


The  differential  equations  describing  the  kinematics  of  a  rotating 
coordinate  frame  with  respect  to  a  fixed  frame,  expressed  in  terms  of 
Euler  parameters,  are: 
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where  {3}  are  the  Euler  parameters  orienting  the  frame  and  {oj}  are  the 
gyro  rates  measured  in  that  frame,  along  the  3  orthogonal  axes. 

In  our  model  we  prefer  to  use  the  Euler  parameters  orienting  the 
vehicle  frame,  V,  with  respect  to  the  inertial  frame,  N.  Therefore,  the 
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gyro  rates,  measured  in  the  G  frame,  must  be  transformed  into  the  V 
frame  via  matrix  VG,  which  we  assume  to  be  constant.  In  addition,  the 
measured  gyro  rates,  {£},  contain  noise  terms  and  other  effects  such  as 
errors  due  to  nonorthogonality  of  the  gyroscopes,  variations  in  the  V-G 
interlocks,  and  gravity  or  magnetic  effects.  We  account  for  these 
effects,  to  first  order,  by  absorbing  all  except  gyro  noise  into  Ixim 
terms,  {b},  one  per  axis.  The  equations  become  (using  letter  subscripts 
to  denote  the  appropriate  coordinate  frame  relationships): 

~  C6vfj][VG]{u)gj^  -  bgjj} 

where  -  {‘^GN}(true)  ^  ^^GN^  9^’’°  biases  are 

assumed  to  be  slowly  varying;  this  allows  us  to  write: 


which  is  valid  over  short  time  intervals.  The  set  of  seven  differential 
equations  (for  the  four  Euler  parameters  and  three  biases)  can  be 
integrated  via  Runge-Kutta  methods  to  yield  a  new  orientation  estimate 
for  Process  B. 

4.2  Kalman  Filter  Equations 

The  two  estimates  of  vehicle  attitude,  one  from  integration  of  the 
kinematic  equations  and  the  second  from  Process  B  attitude  estimation, 
are  combined  to  give  a  best  estimate  of  the  attitude.  We  have  adopted 
the  discrete  Kalman  filter  equations  for  a  linear  system: 
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+  1)  =  X^(k  +  1)  +  K(k  +  l){Y(k  +  1)  -  Y(k  +  1)} 

Pk(k  +  1)  =  P,^(k)  +  P  dt  (4.5a-d) 

^k 

Lw  y  +  H(k  +  l)P.(k  +  l)H''’(k  +1) 

*k+rk+l 

Pk+i(k  +  1)  =  [I  -  K(k  +  ])H(k  +  ])3P^(k  +  ]) 

where 

Xk^l(k  +  1)  =  optimal  estimate  of  the  state  X  at  time  tj^^^  based  on 
k  +  1  data  sets, 

X|^(k  +  1)  =  state  X  at  time  ^k+1  based  on  k  data  sets,  and  calculated 

from  forward  integration  of  kinematic  equations, 

K(k  +  1)  =  Kalman  gain  matrix  for  time 


Y(k  +  1) 

Y(k  +  1) 
Pi(j) 

H(k  +  1) 


=  Values  of  8y|^  from  Process  B  and  bias  values 
from  previous  iteration. 


c— >  =  Values  of  3ww  from  integration  and  bias 

°6n\ 

values  from  previous  iteration. 


=7x7  covariance  matrix  at  time  t^  based  on  i  data 

J 

sets. 


=  ■^rrl  "I  (^0*'  case), 

dX  I  i 

^k+1 


L„  y  =  covariance  matrix  associated  with  measurement  of  the 
''k+rk+l 

state  (or  observations)  from  Process  B  (the  upper  left 
4x4)  and  covariance  for  the  biases  (the  lower  right 


3x3),  and 

=  integration  of  the  matrix  Riccati  equation  for 
covariance  propagation  (see  Appendix  8). 
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Notice  that  we  have  included  the  biases  as  observables  In  our 
Kalman  filter  equations.  By  choosing  the  appropriate  covariance  values 
in  matrix  L  and  P,  we  can  control  the  corrections  to  the  biases.  We 
have  done  this  because  we  hypothesize  that  the  biases  vary  slowly— or  at 
least  the  effects  which  we  are  most  Interested  In  monitoring  vary 
slowly.  Our  simulation  tests  Indicate  that  with  this  formulation  we  can 
follow  the  bias  terms  added  to  the  rate  gyro  data  and  absorb  variations 
In  the  Interlock  matrix  V6  Into  the  bias  terms  with  little  degradation 
In  the  optimal  state  estimate. 
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5.0  Truth  Model  and  Simulation  Tests 

The  algorithms  for  Process  B  and  C  were  tested  by  processing  data 
produced  by  a  simulation  program  (“truth  model")  and  then  comparing  the 
results  with  the  “true"  model.  Each  test  consisted  of  processing  a 
series  of  29  data  frames  separated  by  30  seconds  of  satellite  motion. 

The  most  Important  Input  data  are  the  Image  coordinates  and  Intensities 
of  the  stars  In  each  field  of  view  from  Process  A  and  the  most  Important 
output  data  are  the  calculated  orientation  from  Processes  B  and  C.  The 
simulation  program  was  written  to  Include  variations  in  several  Impor¬ 
tant  parameters  such  as  Euler  parameters  describing  the  relative  orien¬ 
tation  of  the  two  camera  frames,  Euler  parameters  for  the  rotation  from 
the  gyro  to  vehicle  frames,  and  gyro  bias  terms.  To  illustrate  the 
performance  of  our  algorithms  for  this  report  each  series  included  the 
parameter  variations  of  the  previous  model  plus  only  one  additional 
parameter  variation. 

5.1  Simulation  Program 

We  first  describe  briefly  the  creation  of  simulated  data.  The 
first  step  is  to  choose  an  appropriate  satellite  orbit,  specified  by  its 
semimajor  axis,  orbital  period  and  Inclination.  To  facilitate  the 
calculation  of  satellite  position  and  velocity,  we  make  use  of  Herrick's 
two  body  solution  (see  Ref.  6,  p.  155).  To  use  this  method  we  specify 
the  initial  position  and  velocity  components,  expressed  in  the  Inertial 
frame,  and  the  associated  time.  All  later  positions  and  velocities  can 
be  determined  by  specifying  the  desired  time  and  solving  several  equations. 
This  same  method  is  used  to  determine  the  earth's  position  and  velocity 
at  each  time  step.  Velocity  data  are  needed  to  calculate  the  aberration 
of  starlight  which  affects  the  appaient  star  directions. 
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All  of  our  tests  have  assumed  a  circular  satellite  orbit  and  a 
nominally  earth  pointing  vehicle.  To  reflect  this  choice  we  initially 
orient  the  gyroscope  frame  so  that  the  g2  axis  is  perpendicular  to  the 
orbit  plane  and  the  primary  vehicle  rotation  is  about  that  axis.  The  gs 
axis  is  initially  along  the  orbit  radius  vector,  r.»  and  £i  is  given  by 
£2  X  fl.3.  Since  our  primary  orientation  variables  are  as  discussed 
in  Section  2,  we  obtain  their  initial  values  as  follows:  specify  the 
initial  values  for  and  calculate  the  rotation  matrix  VG,  then  use 
the  gyro  unit  vectors  {£}  to  fill  matrix  GN  and  calculate  VN  =  VG  •  GN; 

can  then  be  recovered  from  VN.  All  subsequent  values  of  are 
obtained  by  integrating  the  kinematic  differential  equations  forward  in 
time.  The  gyroscope  rate  history,  needed  for  the  integration,  is  given 
for  the  G  frame;  therefore,  the  rates  are  rotated  into  the  V  frame  by 
matrix  VG,  a  function  of  gyg,  which  can  be  either  constant  or  time 
varying.  See  Appendix  9  for  details  of  rate  gyro  data  simulation. 

At  each  time  step  we  calculate  the  VN  matrix  from  Matrix  BA 

is  computed  from  gg^  (again,  constant  or  time  varying  parameters)  and 
from  BA  we  compute  AV  (see  Appendix  7).  The  last  row  of  AN  =  AV  •  VN  is 
the  FOV(A)  camera  boresight  unit  vector,  needed  to  access  the  star 
catalog  for  a  subcatalog  of  stars.  After  adding  the  effects  of  aber¬ 
ration,  the  stars  are  projected  onto  the  CCD  image  plane  via  the  stellar 
colinearity  equations.  Stars  seen  by  the  second  camera  are  obtained  in 
the  same  manner,  after  first  computing  BN  =  BA  •  AN  to  get  the  boresight 
unit  vector. 

The  image  coordinates  obtained  by  the  above  methods  are  assumed  to 
represent  the  "true"  state.  In  an  actual  system  Process  A  will  not. 
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of  course,  produce  the  true  image  coordinates.  We  have  assumed  that  the 
centroiding  of  an  image  can  be  performed  to  an  accuracy  of  10%  of  a 
pixel  (1-sigma  error)  and  that  systematic  errors  such  as  image  distortion 
can  be  accounted  for  and  removed.  Therefore,  we  perturb  the  true  image 
coordinates  with  Gaussian  noise. 

Various  data  are  stored  on  tape  or  disk  for  later  analysis  by 
Process  B  and  C.  Space  is  left  at  the  end  of  each  record  (one  record 
per  frame)  for  data  computed  by  Processes  B  and  C;  these  are  later 
analyzed  for  accuracy  and  displayed. 

5.2  Simulation  Tests 

A  set  of  eight  models  was  used  to  test  our  algorithms.  All  models 
followed  the  same  orbital  path  and  rotation  history.  Of  the  29  data 
frames,  each  consisting  of  image  coordinates  in  a  pair  of  FOV  and 
separated  by  30  seconds  of  flight  time,  only  once  does  a  FOV  contain 
2  stars  (the  case  at  8  minutes  from  the  start).  In  that  case,  the 
least-squares  solution  used  only  the  stars  from  one  FOV;  the  orientation 
errors  for  this  case  are  relatively  large  in  all  models.  For  display 
purposes,  we  have  plotted  the  root-mean-square  of  the  angular  errors 
between  the  calculated  and  true  vehicle  frame  (using  the  1-2-3  Euler 
angle  set).  There  are  actually  three  calculated  frames:  the  result 
of  Process  B  least-squares,  the  integrated  state,  and  the  optimal 
estimate  from  the  Kalman  filter.  Each  series  started  with  an  estimate 
about  2  degrees  in  error.  Thus,  several  frames  must  be  processed  for 
the  system  to  reach  steady  state. 

No  noise  or  parameter  variations  were  included  in  the  first 
model  in  order  to  verify  that  the  software  could  indeed  recover  the 
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true  state  (Figure  5.1).  Gaussian  noise  added  to  the  rate  gyro  data  (1 
sigma  =  1  arcsecond/ second)  causes  the  integrated  state  of  our  second 
model  to  deviate  from  the  true  state  (Figure  5.2).  It  is  evident  that 
with  this  level  of  noise,  the  state  could  be  integrated  several  minutes, 
at  least,  before  the  accumulated  error  would  place  the  estimated  state 
too  far  from  the  true  state.  Thus,  Process  C  provides  adequate  backup 
for  failures  of  Process  B.  Notice  also  that  the  optimal  estimate  nearly 
matches  the  Process  B  state;  this  is  due  to  the  significantly  smaller 
covariance  associated  with  the  Process  B  result. 

Our  third  test  included  noise  in  the  image  coordinates  (1  sigma  = 
0.0034  mm)  corresponding  to  approximately  10  arcsecond  error  in  deter¬ 
mining  a  star's  direction  (lens  focal  length  =  70  mm).  Once  again  the 
optimal  estimate  is  nearly  the  Process  B  result  (Figure  5.3).  This  and 
all  following  simulation  models  show  that  the  most  important  factor 
affecting  the  vehicle  attitude  determination  accuracy  is  the  accuracy 
with  which  individual  star  centroids  can  be  determined.  A  reduction  of 
centroid  errors  will  produce  a  proportional  reduction  in  orientation 
errors.  Since  the  least-squares  result  nearly  matches  the  optimal 
estimate,  improving  the  star  tracker  performance  will  yield  the  most 
improvement  in  attitude  estimation.  Our  choice  of  10%  pixel  centroiding 
error  for  each  star,  yielding  about  5  arcsecond  vehicle  pointing  error, 
is  considered  conservative.  Indications  are  that  5%  pixel  error  can  be 
obtained  routinely,  with  perhaps  even  smaller  errors  for  brighter  stars 
(considerable  research  is  presently  under  way  to  determine  optimal  "tuning" 
of  the  sensor  and  centroiding  process-clearly  an  appropriate  scale  factor 
can  be  applied  to  our  results  to  reflect  other  centroiding  error  models). 
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The  fourth  model  included  variations  in  the  Euler  parameters 
describing  the  interlock  between  star  tracker  frames.  As  expected,  this 
does  not  seriously  degrade  the  orientation  of  the  vehicle  (V)  frame 
since  its  orientation  is  defined  by  the  boresight  unit  vectors  (Figure 
5.4a).  It  will  be  recalled  that  Process  B  algorithms  estimate  these 
interlock  parameters.  Figures  5.4b-d  display  the  estimates  obtained 
for  the  three  interlock  angles.  Each  figure  shows  the  deviations,  from 
the  nominal  interlock  angle,  of  the  true  angle,  the  angle  calculated 
from  least-squares  and  the  best  estimate  of  the  interlock  angle.  This 
series  used  a  value  5  arcseconds  for  the  variance  of  process  noise 
matrix  in  the  Kalman  filter  calculations.  The  fifth  series  was  identical 
to  the  forth  series  except  we  used  a  value  of  10  arcseconds.  Results  of 
Figure  5.5a  indicate  little  effect  on  the  vehicle  frame  orientation 
while  Figures  5.5b-d  show  improved  interlock  recovery  compared  with 
Figure  5.4b-d.  The  value  used  for  the  process  noise  should  be  influ¬ 
enced  by  the  size  of  the  expected  variations  in  interlocks.  A  strict 
value  (small  noise)  prohibits  the  algorithm  from  following  a  true 
variation  while  a  large  value  leads  to  large  fluctuations  in  the  inter¬ 
locks  and  no  meaningful  self-calibration. 

The  next  several  simulations  concern  Process  C  performance.  First 
we  added  a  time  varying  bias  term  to  each  gyro  axis  in  order  to  test  how 
well  Process  C  algorithms  recover  and  follow  each  bias.  Figure  5.6a 
indicates  the  biases  degrade  the  integrated  state  only  slightly  once 
the  biases  have  been  recovered  (after  several  minutes).  Figure  5.6b 
shows  the  true  and  calculated  bias  values.  By  choosing  a  different 
value  for  the  bias  variance  (see  Section  4)  we  can  control  the  fluctua¬ 
tions  in  the  recovered  biases.  To  demonstrate  this,  in  our  seventh 


series  we  increased  the  variance  square  root  from  0.5  to  1.0  arcsecond/ 
second.  Figure  5.7a  shows  no  effect  on  the  vehicle  frame  determination 
while  Figure  5.7b  indicates  a  faster  bias  recovery  but  somewhat  larger 
bias  fluctuations  compared  with  Figure  5.6b. 

Our  final  simulation  test  included  the  effects  of  time-varying 
and  off-set  Euler  parameters,  describing  the  relationship  between 
the  vehicle  and  gyro  frames.  Process  C  algorithms  assume  this  relation¬ 
ship  is  fixed  (in  our  case  rotation  matrix  V6  is  the  identity  matrix)  so 
any  deviation  will  appear,  over  the  short  interval,  as  simply  an  addi¬ 
tional  bias  term  in  the  gyroscopes.  Thus,  we  see  little  effect  in  the  V 
frame  errors  (Figure  5.8a)  but  notice  the  recovered  bias  values  are 
displaced  somewhat  from  their  previous  tracks  (Figure  5.8b,  variance 
square-root  is  0.5  arcsecond/second).  We  assume  that  other  slowly 
varying  or  constant  effects  will  be  accounted  for  in  like  manner. 

The  choice  for  the  bias  variance  should  be  influenced  by  the 
expected  variations  in  the  gyro  biases  as  well  as  an  estimate  of  vari¬ 
ations  in  other  elements.  As  with  the  FOV  interlock  weight,  a  strict 
value  (small  variance)  restricts  the  tracking  of  a  true  variation  while 
a  liberal  value  negates  the  self-calibrating  nature  of  the  algorithms. 
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Orientation  errors  of  vehicle  frame  for  simulati 
rate  gyro  errors  and  no  image  centroid  errors. 
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Orientation  errors  of  vehicle  frame  for  simulation  test  with 
noise  added  to  rate  tyro  data,  (o  =  1  arc  sec/second). 
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Figure  5.3:  Orientation  errors  of  vehicle  frame  for  simulation  test  with 
image  centroid  errors,  (o  =  0.0034  mm). 
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Orientation  errors  of  vehicle  frame  for  simulation  test 
with  time  varying  interlock  angles  between  camera  frames 
(process  noise  =  5  arcseconds) 
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Deviations  of  the  first  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (0°):-=  true  angle,  +  =  least-squares  estimate,  *  = 

Kalman  filter  estimate. 
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RNGULflR  ERRORS  IN  ORIENTRTION 


5.5a:  Orientation  errors  of  vehicle  frame  for  simulation  test 
with  time  varying  interlock  angles  between  camera  frames 
(process  noise  =  10  arc  seconds) 
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Deviations  of  the  first  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (0°):  =  true  angle,  +  =  least-squares  estimate,  *  = 

Kalman  filter  estimate. 
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Figure  5.5c:  Deviation  of  the  second  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (90°) :  -  =  true  angle,  +  =  least-squares  estimate,  *  = 
Kalman  filter  estimate. 
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Figure  5.5d:  Deviation  of  the  third  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (0°);  -  =  true  angle,  +  =  least-squares  estimate,  *  = 
Kalman  filter  estimate. 


Figure  5,6a:  Orientation  errors  of  vehicle  frame  for  simulation  test  with  time 
varying  gyro  bias  terms. 
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BIAS  RECOVERY  TEST  OF  PROCESS  C 


Figure  5.8a:  Orientation  errors  of  vehicle  frame  for  simulation  test  with  time 
varying  interlock  angles  between  the  gyro  and  vehicle  frame. 
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6.0  Conclusions 

The  simulations  discussed  in  Section  5  illustrate  that  our  algorithms 
can  routinely  yield  5  arcsecond  accuracy  for  the  assumed  star  tracker 
configuration  and  using  up  to  5  stars  in  each  field  of  view.  There  will 
be  occasional  errors  greater  than  5  arcseconds  because  of  too  few  stars 
in  one  or  both  FOV.  Therefore,  we  consider  our  quoted  accuracy  to 
represent  a  one  sigma  error. 

We  have  not  demonstrated  explicitly  that  the  necessary  calculations 
can  be  carried  out  rapidly  enough  to  yield  a  new  attitude  estimate  every 
30  seconds,  as  planned.  However,  this  can  be  accomplished,  we  believe, 
simply  by  converting  our  algorithms  from  an  interpreter  to  compiler  type 
of  computer  language.  Such  a  change  would  probably  reduce  computer  time 
by  a  factor  of  5  to  10  (from  roughly  60  seconds  per  frame  to  less  than 
12  seconds). 

There  are  several  features  of  our  algorithms  which  need  special 
emphasis.  First,  it  is  important  to  keep  in  mind  that  our  algorithms 
assume  a  slowly  rotating  satellite.  Our  algorithms  are  designed  to 
determine  the  vehicle  attitude  provided  there  is  an  attitude  estimate 
which  is  within,  say,  5-10  degrees  of  the  truth.  In  a  steady-state 
mode,  we  can  integrate  rate-gyro  data  between  successive  frames  and 
thereby  provide  sequential  estimates.  However,  there  must  be  some 
system  such  as  horizon  sensors  to  provide  a  rough  attitude  estimate 
either  in  case  of  start-up,  after  vehicle  maneuvers,  and  perhaps  after 
successive  failures  of  Process  B. 

Also,  several  parameters  must  be  chooser  after  a  real  system  is 
designed  or  assembled.  Two  of  these  are  the  variance  for  the  Kalman 
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filter  interlock  estimation  and  the  gyro  bias  variance  for  the  Kalman 
filter  bias  estimation;  both  of  these  are  important  for  the  self-cali¬ 
brating  features  of  our  algorithms.  We  have  not  attempted  to  provide 
the  extensive  error  checking  capability  needed  on  a  flight  system  since 
it  is  impossible  to  foresee  the  many  types  of  failures  or  errors  encoun¬ 
tered  in  a  real-life  situation. 

There  are,  of  course,  many  possible  modifications  and  additions 
which  could  be  made.  One  obvious  modification  is  to  reduce  the  number 
of  stars  used  in  the  least-squares  correction  from  the  current  5  to 
perhaps  3  or  4  per  FOV.  Obviously,  this  will  reduce  the  attitude  accuracy 
but  would  have  the  advantage  of  reducing  computing  time  and  memory 
requirements.  Perhaps  with  some  additional  logic  the  3  or  4  stars  most 
widely  distributed  over  the  FOV  could  be  selected  and  thereby  lessen  the 
impact  of  fewer  stars.  An  improvement  in  attitude  estimation  could  be 
obtained  by  using  a  longer  focal  length  lens  for  each  star  tracker. 

This  reduces  the  pointing  error  to  each  star  due  to  centroiding  errors 
and  therefore  improves  orientation  estimates.  However,  such  a  change 
reduces  the  field  of  view  and  the  number  of  stars  detected  (unless  a 
larger  lens  is  used  to  detect  fainter  stars,  requiring  a  larger  catalog 
as  well). 
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Appendix  1 :  CCD  Star  Tracker 

An  Important  element  of  the  attitude  determination  system  discussed 
in  this  report  is  the  CCD  star  tracker.  In  this  appendix  we  discuss 
some  of  the  key  features  jf  such  a  star  tracker. 

A  CCD  array  has  a  high  degree  of  dimensional  stability  and  is 
relatively  immune  to  magnetic  effects.  These  features  make  it  very 
attractive  for  a  star  tracker.  For  a  general  purpose  tracker  the  field 
size  is  typically  5°  to  10°  wide  and  with  CCD  array  sizes  currently 
available,  the  star  images  would  be  a  fraction  of  a  pixel  in  diameter. 

By  defocusing  the  camera  lens  slightly  so  a  typical  image  covers  a  3  x 
3  array  of  pixels  an  image  centroid  can  be  computed  with  at  least  10% 
pixel  accuracy.  By  applying  a  stored  correction  function,  this  error 
can  be  reduced  still  further. 

Two  other  factors  affecting  centroid  accuracy  are  pixel  response 
variations  and  photon  noise.  Response  variations  can  be  corrected  via 
a-priori  calibration.  However,  due  to  time  and  computer  memory  limita¬ 
tions  only  the  most  severe  variations  would  be  corrected  in  practice. 
Cooling  the  CCD  reduces  thermal  noise  but  the  photon  noise  is  always 
present,  affecting  fainter  images  more  than  brighter  images.  It  is 
expected  that  a  star  tracker  with  sophisticated  software  could  determine 
centroids  with  an  accuracy  of  5%  of  a  pixel  (la)  for  minimum  brightness 
stars  and  perhaps  2-3%  error  for  the  brightest  stars. 

To  prevent  the  star  images  from  smearing  on  the  CCD  due  to  vehicle 
motion,  the  expoiuAz  time  or  integration  time  must  be  kept  short.  On 
the  other  hand,  the  analog  voltage  response  from  star  illuminated  pixels 
must  be  accurately  converted  to  a  digital  value,  a  relatively  slow 
process.  Several  techniques  can  be  employed  to  improve  read  out  speed. 
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The  first  is  to  trigger  the  analog  to  digital  (A/D)  conversion  only  for 
preselected  pixels  or  those  that  exceed  a  minimum  threshold.  Preselec¬ 
tion  can  be  done  after  a  set  of  stars  has  been  located  from  the  previous 
frames,  while  the  triggering  method  can  be  instituted  in  a  search  mode. 

A  second  speed  gain  can  be  achieved  by  Zine-sfeipping’—skipping  the  read¬ 
out  of  rows  of  pixel  responses  after  they  have  been  transferred  from 
vertical  registers  into  the  horizontal  register.  This  technique  can  be 
employed  in  the  track  mode  once  a  set  of  stars  has  been  located. 

We  anticipate  that  Process  A  will  be  able  to  received  multiple 
frames  of  data  from  the  star  trackers  before  Process  B  is  ready  to 
accept  new  data.  This  may  allow  Process  A  time  to  edit  the  data  such  as 
predicting,  crudely,  where  the  stars  may  appear  in  the  next  frame 
and/or  providing  Process  B  with  some  average  position  for  each  star  in  a 
frame.  This  latter  technique  could  improve  the  projected  accuracy  by 
averaging  out  some  random  position  errors. 


i 


AoDendlx  2:  CCD  Instrument  Response  and  Stellar  Magnitude  Conversion 


As  mentioned  in  Section  1»  the  outputs  of  Process  A  are  the  inter¬ 
polated  centroids  and  instrument  magnitudes  for  each  valid  star  image. 
The  purpose  of  this  Appendix  is  the  discussion  of  the  approximate  tech¬ 
niques  utilized  in  the  synthesis  of  these  two  outputs. 

A2.1  The  Star  Centroids 

The  centroid  location  (x^,y^)  is  given  by 
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where  Rjj  is  the  A/D  converted  response  level  of  the  pixel  located  at 

*  J 

(x^-.y^-)  and  the  summations  are  over  the  square  array  of  pixels  illuminated 
by  the  defocused  star  image  (9  to  16  pixels). 

Typical  cell  size  for  a  CCD  is  approximately  0.030  mm  on  a  side. 

A  CCD  placed  behind  a  70  mm  focal  length  lens  (proposed  for  one  CCD 
star-sensor)  gives  a  resolution  of  approximately  1.5  arc -minutes  for  a 
focused  image.  When  apread  over  a  3  x  3  or  4  x  4  cell  pattern,  the 
resolution  with  which  the  centroid  can  be  located  has  been  found  to  be 
£  6  arc-sec.  For  double  stars.  Process  A  would  produce  image  coordinates 
for  a  single  star  but  with  poorly  determined  image  coordinates  (a  weighted 
mean  of  the  two  stars). 

Detections  of  double  stars  should  not  be  used  in  Process  B  since 
they  would  result  in  poor  orientations.  One  solution  to  this  problem 
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is  to  delete  from  the  mission  catalog  all  star  pairs  with  separations 
less  than  some  tolerance  ("“6  arc-min.  in  this  case).  There  are  sufficient 
stars  in  the  catalog  that  this  deletion  should  not  seriously  degrade 
performance.  Some  additional  time  in  Process  B  will  be  used  trying 
unsuccessfully  to  pair  measured  double  stars  with  catalog  stars,  but 
since  detection  of  double  stars  will  be  a  relatively  rare  event,  this 
time  penalty  should  not  be  a  significant  practical  problem. 

A2.2  CCD  Magnitude  Response 

A2.2.1  Magnitude  Conversion 

Due  to  both  the  different  spectral  qualities  of  various  stars  and 
the  peculiarities  in  the  unfiltered  CCD  response  (the  primary  sensitivity 
is  to  red  or  near  infra-red  radiation)  two  stars  of  the  same  visual  (V) 
magnitude  (for  example)  may  cause  different  CCD  response.  Hence  none 
of  the  cataloged  star  magnitudes  may  be  used  directly.  Rather,  the 
magnitudes  of  the  stars  must  be  properly  transformed  (using  the  spectral 
properties  contained  in  the  master  star  catalog  SKYMAP)  prior  to  inser¬ 
tion  in  the  mission  catalog.  Simply  stated,  the  mission  catalog  must 
contain  an  "instrument  magnitude"  for  each  star. 

It  has  been  decided  to  convert  the  V  magnitudes  of  SKYMAP  to  I 
magnitudes  and  utilize  an  I  filter  placed  over  the  CCD  array.  The 
following  points  support  this  decision: 

(1)  Given  the  information  in  SKYMAP,  one  could,  in  principle, 
perform  a  magnitude  conversion  from  V  to  a  CCD  magnitude. 
However,  this  would  require  the  choice  of  a  particular  CCD 
detector  in  order  to  determine  its  response  characteristics  in 
the  laboratory. 
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(2)  The  response  functions  of  typical  CCD's  are  quite  broad,  a 
fact  which  makes  a  rigorous  conversion  to  a  CCD  magnitude 
difficult  in  light  of  the  complicated  stellar  spectral  features 
in  the  blue  wavelength  region.  A  detailed  description  of  the 
spectra  would  be  required.  The  I  filter,  on  the  other  hand, 

is  confined  to  the  red  wavelengths  where  the  star  spectra  are 
relatively  smooth. 

(3)  The  I  filter  response  peak  is  near  that  of  typical  CCD's,  In 
addition,  it  overlaps  the  main  peaks  of  the  commonly  accepted 
"typical  CCD  response"  (Ref.  6).  Hence,  an  I  filter  placed 
over  the  CCD  array  would  serve  to  limit  the  wings  of  the  CCD 
response  and  still  provide  adequate  through-put  for  sensitivity. 

(4)  Information  exists  for  converting  V  magnitudes  to  I  magnitudes. 
The  transformation  requires  only  spectral  type  and  luminosity 
class  -  both  readily  available  from  SKYMAP. 

In  the  ideal  case,  the  set  of  detectable  stars  exactly  matches  the 
catalog.  Since  this  is  not  possible,  it  is  desirable  to  maximize  the 
completeness  of  the  catalog  to  some  rather  faint  magnitude  to  insure 
that  most  detectable  stars  are  contained.  It  is  important  to  note  that 
stars  which  are  faint  in  V  may  be  relatively  brighter  at  red  wavelengths. 
As  will  be  demonstrated  in  the  next  sections,  a  limit  of  magnitude  5  in 
I  seems  to  be  a  reasonable  limit  for  the  CCD  configuration  assumed  for 
the  present  study.  The  8th  magnitude  limit  of  SKYMAP  assures  that  the 
mission  catalog  listing  will  be  sufficient. 

A2.2.2  The  I  Magnitude  Conversion  Method 

Two  external  items  of  information  are  needed  for  the  magnitude 
conversion.  Values  of  were  obtained  from  Johnson  [7],  whose 
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table  contains  listings  for  three  luminosity  classes  (I,  III  &  V  - 
super  giants,  giants  and  in?/in  sequence)  and  extends  over  most  spectral 
types.  The  second  value  needed  Is  Sj/a^,  the  ratios  of  absorption  in  I 
to  absorption  in  V,  expressed  in  magnitude  and  as  a  function  of  spectral 
type  by 

aj  log^o[(/Q“l(X)E(X)(l  -  I(X)dX)/(/o”l(X)E(X)dX)] 

"  logioC(/o“V(A)E(X)(l  -  I(X)dX)/(/Q“V(X)E(X)dX)] 

Where  I{X)  and  V(X)  are  the  filter  responses,  E(X)  is  the  star  energy 
function  and  I(X)  is  the  relative  absorption  function  and  X  is  the 
wavelength.  (See  SKYMAP  desciption  [5]  for  details).  As  pointed  out  in 
SKYMAP,  this  ratio  is  nearly  constant  over  spectral  type  for  narrow  or 
intermediate  band  filters.  To  calculate  this  ratio  the  Planck  energy 
function  was  used  to  model  the  stellar  flux.  Although  this  is  not 
precisely  valid,  forming  the  ratio  should  lead  to  quite  accurate  results. 
The  temperatures  used  were  those  given  by  Johnson  [7]  and  no  distinction 
was  made  by  luminosity  class.  The  values  for  absorption  were  taken  from 
Fig.  3.2  in  the  SKYMAP  description  by  assuming  absorption  in  magnitude 
is  a  linear  function  of  wavelength  over  the  range  of  interest  (4800  A  - 

10000  A), 

a(X)  =  1.77  X  10"“  X  x(A)  +  1.77,  (A2.4) 

Where  a(X)  is  absorption  in  magnitude  at  wavelength  X.  The  results  of 
these  calculations  were  that  aj/a^  varied  from  0.25  to  0.32.  The  same 
value  of  aj/ay  was  used  for  I,  III  and  V  luminosity  class  stars  at  a 
given  spectral  type. 

A2.2.3  SKYMAP  DATA 

The  data  from  SKYMAP  needed  for  the  magnitude  conversion  consists 
of  apparent  visual  magnitude,  spectral  type,  luminosity  class  and 
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absorption  in  V.  These  data,  with  the  exception  of  a^,  are  given  for 
most  stars.  It  was  necessary  to  collapse  categories  of  luminosity  class 
and  some  spectral  types  since  the  table  from  Johnson  is  limited. 

Collapsing  is  justified  in  most  cases  because  either  the  category  contains 
few  stars  and/or  the  properties  are  similar  to  those  of  listed  star 
types.  The  following  combinations  were  used: 


R 

N 

C 

S 


WR 

UC 

WN 

IV 

III 

II 


] 

] 


Luminosity  class  III,  spectral  type  M 
(all  are  variants  of  M  III) 


Lum  class  III,  spectral  type  09 
(all  are  hot  giant  stars  similar  to  09) 


III 

V 

I 


No  Luminosity  class  V  (most  stars  are  V  stars) 

No  subinterval  in  spectral  type  ■+■  5  (i.e.,  A  becomes  A5) 

No  absorption  given  -*•  set  to  0 
No  spectral  type  exclude 

Given  the  spectral  type  and  luminosity  class,  the  value  of  V^j^^  -  1^^^^ 
and  aj/ay  were  found  by  interpolation  in  the  table.  Then: 
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"•l  =  '"V  ■  (''abs  ‘  ^abs^  ■ 
where  m^  and  a^  are  from  SKYMAP. 

SKYMAP  contains  approximately  45,000  stars.  Of  these,  37  were  not 
processed  due  to  missing  spectral  type  or  visual  magnitude. 

A2.2.4  Magnitude  Limit  of  CCD  Sensor 

In  order  to  establish  a  reasonable  magnitude  limit  for  a  CCD  sensor 
we  1)  determine  the  flux  in  the  filter  bandpass  for  some  standard  star 
at  the  eartn's  atmosphere,  and  2)  multiply  by  appropriate  factors 
dictated  by  the  sensor. 

The  most  direct  way  to  obtain  a  flux  estimate  would  be  to  observe 
known  stars  from  space  with  the  CCD  sensor.  Barring  this,  gound-based 
observations  of  stars  with  varying  zenith  angles  could  yield  flux 
estimates  outside  the  earth's  atmosphere. 

Our  approximate  method  was  to  numerically  integrate  the  surface 
flux  distribution  of  a  K7  V  star  model  atmosphere  over  the  I  bandpass. 
The  absolute  I  magnitude  of  such  a  star  is  approximately  6.2  (V  =  8.1, 

V  -  I  =  1.92).  The  radius  is  given  by  log  =  -0.11  where 

R  =  6.96  X  10^°  cm.  The  surface  flux  is  scaled  by  (§ - x  yl^)^ 

^un  'V 

=  3.08  X  10"‘®  where  Ip^  =  3.08  x  10^^  ctn.  The  result  of  integrating 
and  scaling  is: 

■“1024  photons/cm^sec. 

Typical  scale  factors  are: 

-Lens  area:  26.7  cm^ 

-CCD  response  peak  efficiency  =  .60 
-I  filter  transmission  peak  efficiency  =  0.85 
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-CCD  effective  area  utilization  =  0.46 

-Integration  time  =  0.1  sec. 

If  we  desire  a  minimum  of  7500  photons/star  for  a  sufficient  signal -to- 
noise  ratio,  we  compute  the  I  magnitude  limit  of: 

"’limit  " 

Note  that  many  factors  are  uncertain  or  could  be  altered.  Integration 
time  could  be  increased  to  1  sec  to  give  a  limit  of  6.0.  We  have  chosen 
5.0  to  be  the  cutoff  magnitude  since  this  seems  obtainable  and  gives 
approximately  5400  stars,  a  sufficient  number  for  the  pattern  recognition 
process  to  work  reliably. 

We  also  note  that  model  atmospheres  for  a  variety  of  spectral  types 
could  be  used  to  repeat  the  above  calculation  to  yield  a  more  precise 
magnitude  limit. 

The  magnitude  limit  is  flexible  since  the  integration  time  for  the 
star  sensor  is  variable  over  a  wide  range.  If  the  integration  time  is 
changed  by  a  factor  of  10  the  magnitude  limit  is  changed  by  2.5  mag.  In 
addition,  the  dynamic  range  to  typical  CCD  arrays  is  200  or  about  6 
magnitudes.  The  response  is  linear  over  the  range  to  allow  accurate 
magnitude  calibration  and  detection. 
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Appendix  3:  Star  Data  Base  And  Mission  Catalog  Creation 

The  star  catalog  data  base  system  SKYMAP  (Ref.  5)  has  been  selected 
as  the  master  star  data  base.  The  SKYMAP  catalog  was  developed  from 
the  SAO  catalog  and  other  sources  specifically  for  attitude  determination 
programs  by  NASA-GSFC.  It  is  complete  to  the  eighth  magnitude  in  either 
the  blue  (B)  or  visual  (V)  magnitudes.  Additionally,  the  catalog 
contains  right  ascensions,  declinations,  and,  when  known,  the  spectral 
type,  luminosity  class,  and  amount  of  interstellar  absorption  in  the  V 
wavelength  range.  Recent  work  [at  the  Naval  Surface  Weapons  Center]  has 
uncovered  a  significant  number  of  corrections  to  the  SKYMAP  data  base 
which  will  be  reflected  in  future  revisions  of  the  present  SKYMAP 
data  base. 

The  on-board  (or  mission)  star  catalog  is  divided  into  celestial 
sphere  cells  so  as  to  permit  efficient  microcomputer  access  during  the 
pattern  recognition  process.  In  order  to  keep  storage  requirements  for 
the  mission  catalog  to  a  minimum,  the  cells  do  not  overlap.  The  place¬ 
ment  of  the  cell  centers  is  given  by  the  polar  angle  0  and  longitude 
A  according  to 

6^  =  cos"'(C^)  n  =  0,1,2. ..N  (A3.1) 

and 

A^j=|^  j  =  0,1,2, ...2n  (A3. 2) 

=  (-1)"  cos(^),  n  =  0,1,2. ..N  (A3. 3) 

These  formulae  yield  (N+1)^  points:  N+1  polar  angles  or  declination 
zones  with  spacing  27r/(2N+l),  and  (2n+l)  equally  spaced  regions  in 
each  zone. 
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The  choice  of  N  1s  somewhat  arbitrary.  A  large  N  yields  small  cells 
which  would  require  more  than  one  cell  to  be  accessed;  a  small  N  yields 
large  cells  which  would  Increase  the  number  of  trials  In  the  pattern 
recognition  process  as  well  as  causing  a  possible  storage  problem. 

Taking  Into  account  the  7“  x  9“  fleld-of-vlew,  a  value  of  N  =  22  was 
chosen,  yielding  529  cells. 

To  facilitate  computer  access,  the  cells  are  ordered  within  memory 
according  to  a  parameter  n^+j;  a  table  lists  the  starting  relative 
address  of  each  cell  and  the  number  of  stars  In  each.  Thus,  given  a 
boresight  estimate  (0,X),  the  primary  cell  location  Is  given  by 

n  =  2[0/A0  +  0.5]  (0  <  90°) 

=  2N  +  1  -  2[0/A0  +  0.5]  (0  >  90°)  (A3. 4) 

j  =  [A/ AX  +  0.5],  (A3. 5) 

where  [x]  Indicates  Integer  arithmetic  (truncation  to  next  smallest 
Integer).  The  table  of  cells  Is  then  consulted  for  identification  of 
the  appropriate  memory  location.  In  all,  the  catalog  access  routine 
reads  data  from  the  4  nearest  neighboring  cells  around  the  estimated 
boresight  (Figure  A3.1)  and  thus  provides  nearly  complete  coverage  of 
the  estimated  FOV  by  the  4  cells. 

The  CCD  Is  assumed  (see  Appendix  2)  to  respond  to  stars  of  I 
magnitude  5  or  lower  -  approximately  5400  stars.  If  these  5400  stars 
are  assumed  to  be  distributed  uniformly  over  the  celestial  sphere,  the 
star  density  p  would  be 


-  5400  stars/ sphere 
^  “  41,253  square  degrees/ sphere 


(A3. 6) 


=0.13  stars/square  degree 
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For  a  field-of-view  of  7°  x  9°  =  63  square  degrees,  we  would  expect 

(63  square  degrees) (0.1 3  stars/square  degree)  =8.2  stars* 

in  a  field-of-view  (assuming  uniform  density).  To  obtain  a  measure  of 
the  range  of  the  number  of  stars  actually  detectable  per  field-of-view, 
the  boresight  was  randomly  oriented  over  the  entire  celestial  sphere  100 
times.  For  each  trial,  the  mission  catalog  was  consulted  and  the  number 
of  stars  in  the  field-of-view  recorded.  The  average  number  of  stars  per 
field-of-view  was  six;  in  no  case  were  fewer  than  two  stars  in  the 
field-of-view. 


*Due  to  non-uhiform  star  population 
number  decreases  to  about  5  at 


of  the  celestial  sphere,  this 
the  north  galactic  pole. 
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Appendix  4:  Inter-Star  Cosine  Calculations 

The  key  to  efficient  star  identification  is  to  take  advantage  of 
the  sub-ten-arcsecond  precession  of  Process  A;  the  angles  between  pairs 
of  measured  stars  are  very  well  determined  by  the  measured  coordinates 
and  can  be  used  to  identify  the  corresponding  catalog  stars.  The  cosine 
of  the  angle  between  a  typical  pair  of  measured  stars  can  be  computed 
from  the  measured  image  coordinates  as 

x.-x.  +  y.y.  +  f" 

c..  H  cos  8..  =  - -  (A4.1) 

/(x,“  t 

The  cosine  of  the  angle  between  a  typical  pair  of  catalog  stars  can  be 
computed  from  the  catalog  direction  cosines  as 

Cjj  i  cos  0JJ  =  Lj^  +  Lj2  Lj2  +  '-J3-  (A4.2) 

The  pattern  recognition  logic  we  developed  makes  use  of  the 
smallness  of  the  difference  between  (A4.1)  and  (A4.2)  as  a  means  to 
tentatively  identify  measured  stars  in  the  catalog.  Our  strategy 
assumes  a  steady-state  condition  in  which  the  estimated  boresight  is 
within  a  degree  or  so  of  the  true  boresight  direction.  Thus,  the 
highest  probability  of  finding  a  pair  match  lies  in  comparing  stars  from 
the  center  of  the  sub-catalog  distribution.  For  this  reason,  we  sort 
the  sub-catalog  stars  by  angular  distance  from  the  boresight.  We 
proceed  to  pair  catalog  stars  by  using  the  sum  of  the  star  indices 
(after  sorting)  as  our  criterion  for  the  pairing  order.  Each  catalog 
pair  is  compared  with  the  pairs  of  measured  stars  (cosines  are  stored 
in  a  table).  We  eliminate  from  consideration  star  pairs  with  separation 
less  than  one  degree  because  of  the  possible  large  "roll"  error  about 


the  boresight.  In  addition,  we  do  not  use  catalog  pairs  with  sepa¬ 
rations  greater  than  about  10  degrees  (greater  than  the  FOV  size).  If 
we  find  agreement  between  a  catalog  pair  and  measured  pair  we  perform  a 
magnitude  test  to  resolve  the  180°  ambiguity. 

The  above  strategy  is  not  necessarily  optimal.  However,  we  have 
found  it  to  be  very  efficient  and  it  allows  for  c.  mismatch  of  several 
degrees,  at  least,  between  the  estimated  and  true  boresight  vectors. 
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Appendix  5:  Stellar  Aberration 

The  effect  of  stellar  aberration  is  to  cause  a  star's  apparent 
direction  to  shift  towards  the  direction  of  the  observers  motion.  The 
amount  of  shift  depends  on  both  the  velocity  of  the  observer  and  on  the 
angle  between  the  observer's  line  of  sight  (the  star  direction)  and  the 
velocity  vector.  The  shift  is: 

a  =  ^  sin  a  (A5.1 ) 

where  a  =  aberration  in  radians 
V  =  observer's  speed 
c  =  velocity  of  light 

a  =  angle  between  velocity  vector  and  the  true  star  direction. 

For  our  purpose,  we  must  express  a  star's  shifted  direction  in  terms  of 
the  true  direction,  the  vehicle  velocity  and  the  angle  between  the 
velocity  vector  and  true  direction;  that  is, 

,4.v,a)  (A5.2) 

If  we  let  ^  be  the  velocity  of  starlight  in  the  inertial  frame  and 
v  be  observer  velocity,  then  the  relative  velocity  of  the  starlight  as 
seen  by  the  observer  is: 

^  -  V  (A5.3) 

Now,  if  we  let  S-  be  the  unit  vector  in  the  true  direction  and  the 
unit  vector  in  the  shifted  direction,  we  can  rewrite  this  as  (refer  to 


Figure  A5.1) 


(c  +  V  cos  a)  £'  =  +  V 

'  '  — n  — n  — 

To  first  order  this  becomes 


(A5.4) 

(A5.5) 


This  equation  is  used  for  calculating  the  displacement  of  a  star's 
unit  vector.  The  velocity  vector  is  computed  for  the  combined  velocity 
of  the  earth  and  satellite  and  Herrick's  "f  and  g"  solution  is  used  to 
calculate  the  individual  velocities  each  time  Process  B  accepts  new  data 
from  Process  A. 

We  note  several  points  concerning  the  effects  of  aberration  on  the 
star  tracker.  The  speed  of  the  earth  in  its  orbit  is  30  km/s  and  the 
maximum  speed  of  an  earth  orbiting  satellite  is  <  8  km/s  relative  to 
the  earth.  Therefore,  the  maximum  shift  in  a  star's  direction  is  about 
26  arcseconds.  This  maximum  occurs  for  stars  90°  from  the  velocity 
vector.  However,  all  stars  in  this  neighborhood  will  be  shifted  by 
nearly  this  amount  and,  thus,  the  distortion  of  the  FOV  will  be 
insignificant.  However,  aberration  will  displace  the  boresight  direction. 
To  avoid  orientation  errors  in  the  combined  FOV(A)  and  FOV(B)  soiution 
we  must  correct  the  catalogue  direction  cosines  by  applying  Eq.  (AS. 6). 


For  those  stars  in  the  direction  of  the  velocity  vector,  the  shift 
in  direction  will  be  small.  But  since  the  shift  is  always  towards  the 
velocity  vector  the  distortion  is  noticeable  (an  apparent  shrinking  of 


the  FOV).  In  this  case,  the  aberration  should  be  applied  before  the 
final  least-squares  solution  for  the  single  FOV. 

We  have  chosen  to  correct  for  aberration  when  a  sub-catalog  is 
selected  from  the  mission  catalog.  This  decision  was  based  on  programing 
ease  although  it  does  require  more  time  to  correct  the  whole  sample 
rather  than  only  the  matched  stars.  The  impact  is  not  severe,  however, 
since  the  calculation  is  very  simple. 


i 

I 

I 


6 


71 


Appendix  6: 


Least-Squares  Correction  Techniques 


In  Process  B  we  seek  to  minimize  the  sum  of  the  squares  of  the 
residuals  between  measured  star  image  coordinates  and  predicted  coordi¬ 
nates  for  the  same  stars,  using  direction  cosines  from  the  on-board 
catalog.  The  mapping  of  catalog  positions  onto  the  CCD  image  plane  is  a 
function  of  Euler  parameters  via  the  stellar  colinearity  equations: 


X  =  fjANiiLi  +  AN12L2  +  ANiaLaj 
JANsiLi  +  AN32L2  +  ANsaLaj 


y 


^[aNziLi  +  AN22L2  +  AN23L3I 
|AN3iLi  +  AN32L2  +  AN33L3 


(A6.1) 


where 


f  =  lens  focal  length 

AN^j  =  elements  of  the  coordinate  frame  rotation  matrix  [AN]. 

=  star  direction  cosines  for  the  particular  star,  measured  in 
the  N  frame. 


If  we  let: 

^  =  vector  of  calculated  CCD  image  plane  coordinates. 

X  =  {(x^,y^)}jjj  =  vector  of  measured  star  image  positions  on  the  CCD. 
and 

AX  =  X  -  X  =  vector  of  residuals, 

then  we  seek  to  find  the  set  of  Euler  parameters,  3,  such  that  the 
weighted  sum  of  the  squares  of  the  residuals  is  minimized;  i.e.,  minimize 

<t»  =  AxJwAXp  (A6.2) 


where 
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and 

Xp  =  vector  of  linearly  predicted  image  coordinates. 

But,  by  first-order  Taylor  expansion 

AX„  =  AX^  -  AAB 
P  C 

where 

AX^  =  vector  of  current  image  coordinate  residuals  based  current 
estimates  of  3. 

A  =  matrix  of  partial  derivatives  of  the  colinearity  equations 
with  respect  to  Euler  parameters. 

AB  =  corrections  to  the  current  estimates  of  Euler  parameters. 

Thus,  we  can  write: 

(|)p  =  (AX^.  -  AAB)^  W(AXg  -  AAB).  (A6.4) 

In  addition  to  finding  the  set  of  Euler  parameters  to  minimize  (})p,  we  must 
also  satisfy  the  constraint  equation: 

B^B  =  1.  (A6.5) 

Letting  Bp  =  B^.  +  AB,  we  find: 

(Bj.  +  AB)^  (S^.  +  AB)  =  1 

or  to  first  order: 

1  -  bJBj.  =  2bJaB.  (A6.6) 

Thus,  our  problem  requires  that  we  minimize  Eq.  A6.4  subject  to  the 
constraint  equation,  Eq.  A6.6.  The  constraint  equation  can  be  incorpor¬ 
ated  in  Eq.  A6.4  as  an  additional  perfect  observation  equation  but  with  a 
large  weight.  That  is,  AY  =  (1  -  B^B)  is  appended  to  the  AX^  vector  and 
2B^  appended  as  an  additional  row  into  the  A  matrix.  The  relative  weight 
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for  this  equation,  the  last  element  of  W,  is  chosen  large  enough  (about 
10^)  so  that  (A^WA)“*  does  not  change  appreciably  for  variations  in  this 
weight.  Then,  for  minimization,  we  require: 

V^g(J)  =  -2A^WAX^  +  2(A^WA)A6  =  0 
or 

A3  =  (A%)‘'  A^WAX^.  (A6.7) 

Determination  of  Interlock  Euler  Parameters  Between  FOV(A)  and  FOV(B) 

Process  B,  in  analyzing  star  image  data,  first  treats  FOV(A)  and 
FOV(B)  independently.  The  least-squares  differential  correction  deter¬ 
mines  the  best  estimate  of  the  Euler  parameters  orienting  the 

vehicle  frame,  V  (see  Appendix  7),  relative  to  the  inertial  frame,  N. 

For  FOV(B)  the  interlock  relationship  between  FOV(A)  and  FOV(B)  (3g^)  is 
assumed  known  and  3y|^  is  adjusted  again.  In  reality,  however,  the 
interlocks  do  vary  slightly  with  time.  Therefore,  we  have  expanded  our 
algorithm  to  treat  the  combined  data  from  FOV(A)  and  FOV(B)  in  order  to 
determine,  simultaneously,  the  and  3g^  which  minimize  (in  a  least- 
squares  sense)  the  star  image  coordinate  residuals  (see  Appendix  7  for 
further  details). 

In  order  to  rigorously  interpret  (A^WA)”‘  as  the  8x8  covariance 
matrix  of  the  estimated  Euler  parameters,  W  should  be  chosen  as  the 
inverse  of  the  "measurement"  covariance  matrix.  However,  since  a  scale 
factor  on  w  is  formally  immaterial  in  the  least  squares  solution  and 
assuming  all  measurement  errors  are  uncorrelated  we  exercise  the  simple 
option  of  setting  W  to  an  identity  matrix  except  for  the  larger  constraint 
weights;  the  correct  covariance  matrix  is  obtained  by  simply  multiplying 
the  converged  (A^WA)"‘  matrix  by  the  image  coordinate  measurement 
variance.  The  two  constraints  of  the  form  (A6.6)  are  treated  as  "perfect 
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measurements".  Thus,  it  is  clear  that  the  two  corresponding  formal 
weights  are  it  is  equally  clear  that  we  are  limited  to  choosing  a 
sufficiently  large  number  (about  10^)  in  practice.  We  have  carried  out 
sufficient  experimentation  to  expect  no  implementation  problems  here; 
the  differential  correction  process  converges  well. 

We  have  found  it  desirable  to  further  process  the  interlock  Euler 
parameters,  gg^.  We  assume  (justifiably!)  that  these  interlocks  vary 
slowly  with  time,  but  the  interlocks  calculated  by  the  combined  least- 
squares  method,  discussed  above,  show  relatively  large  scatter  about 
their  true  values.  This  sensitivity  is  due  to  the  relatively  poor 
determination  of  the  roll  about  each  boresight  (this  does  not  affect  the 
determination  of  To  better  monitor  the  interlock  parameters  we 

adopted  a  discrete  Kalman  filter  algorithm  to  combine  the  predicted  gg^, 
determined  from  previous  data  frames,  with  the  gg^  computed  by  the 
least-squares  correction.  The  equations  needed  for  this  are: 


^  1^)  ( Bgy^(  k)  -  Bgy^(l^)) 

K(k)  =  Pk.i(k)(Lv^V,^  +  Pk-l^*"))'' 
Pk-l(k)  =  Pk-l^'^"'')  ^ 

=  (I  -  K(k))P,^_^(k) 

Q(k)  =  BQ'B^ 


where  Bg|^(k)  =  optimal  estimate  of  interlock  parameters  at  time  tj^ 
obtained  by  combining  predicted  and  computed  values. 


iaiiiiiiawiK. 
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^BA^k) 

eB^(k) 

K(k) 

Pi(j) 


Q(k) 

Q' 


predicted  interlock  parameters  at  time  t|^  based  on 
previous  analysis, 

interlock  parameters  at  time  tj^  obtained  via  least- 
squares  correction, 

Kalman  gain  matrix  at  time  tj^, 

covariance  matrix  associated  with  at  time  tj  based 
on  analysis  of  interlock  values  through  time  t^, 
covariance  matrix  associated  with  calculated  interlock 
parameters , 
process  noise  matrix, 

process  noise  matrix  for  3  interlock  angles  ((j>  = 

{(()j  ,412,413}) 


Formally,  P|^_i(k)  would  be  obtained  by  forward  integration  of  the  matrix 
Riccati  equation,  or  by  other  methods.  However,  since  to  first  order, 
ggA  “  0  3>id  assuming  the  process  noise  is  constant  in  time  as  well, 
Pk_i(k)  is  obtained  by  simply  adding  the  time  integral  of  the  process 
noise,  Q(k),  to  the  previous  covariance,  P|(_'i(k-1).  In  addition,  for 
simplicity  we  assume  Q'  is  diagonal  with  equal  noise  for  each  angle. 

For  programming  ease  we  have  used  a  pre-calculated  B  matrix,  valid  for 
our  nominal  interlock  arrangement. 

The  process  noise  matrix  Q'  essentially  controls  the  scatter  of 
the  estimated  Euler  parameters.  Small  values  for  the  elements  of  Q'  will 
permit  little  change  in  the  (making  it  insensitive  to  each  new 
However,  this  may  cause  the  Sg^  not  to  "track"  the  true  variations. 
Conversely,  large  values  for  Q'  elements  will  cause  more  scatter  in  ttg^. 
Obviously,  Q'  is  a  "tuning"  parameter  which  must  be  selected  for  the 
particular  system. 
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Appendix  7:  Orientation  of  the  Vehicle  Frame 

We  describe  the  vehicle  orientation  by  the  set  of  Euler  parameters, 

which  orient  a  "V"  frame  (defined  below)  relative  to  the  inertial 
frame,  "N".  The  V  frame  is  defined  entirely  by  the  boresight  vectors  of 
the  two  star  sensors  [FOV(A),  FOV(B)].  Given  the  boresight  of  FOV(A)  as 
^3  and  of  FOV(B)  by  we  define  the  V  frame  unit  vectors  as  follows: 

^1  =  {^3  +  ^3)/(1^3  +  ^sl) 

V3  =  (as  X  b3)/(la3  x  ba])  (A7.1) 

^2  =  Va  X 

The  advantage  of  this  frame  is  that  since  the  boresights  of  the  two  FOV 
are  well  determined  so  also  will  be  the  V  frame  and,  hence,  the 
parameter  set.  The  poorly  determined  roll  angle  about  each  boresight 
will  not  affect 

In  addition  to  we  also  make  use  of  the  Euler  parameters 
orienting  FOV(B)  with  respect  to  FOV(A).  These  parameters  are  monitored 
as  a  means  for  monitoring  the  interlock  angles  between  F0V{A)  and  FOV(B). 

As  we  will  show  below,  we  do  not  actually  need  the  v  unit  vectors 
calculated  by  the  above  equations.  We  do  need,  however,  the  rotation 
matrix  AV  which  rotates  the  V  frame  into  the  F0V{A)  frame.  The  matrix 
AV  can  be  calculated  from  the  BA  rotation  matrix. 

Matrix  AV  can  be  constructed  by  filling  its  columns  with  the  v  unit 
vectors  expressed  in  the  A  frame.  We  first  express  b3  in  terms  of  ^ 
unit  vectrors  in  order  to  calculate  the  vectors  vi,  ^2,  V3  (in  the  A 
frame) . 

b?  =  BA  a?  (A7.2) 


And  since 
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we  see  that 


(A7.3) 


(A7.4) 


Therefore,  in  the  A  frame: 

=  (^3  +  ^3)/ (1^3  ka  1 ) 


- Mii -  ^  ^  1  •*•  SA3  3^ 

(2  +  2BA33)  (2  +  28A33)  (2  +  2BA33) 


(A7.5) 


^3  =  {^3  b3)/(1^3  ^  bs  I ) 


- 

"BAs  2^ 

-  BA|.)‘^" 

BA 


(1  -  BAI3) 


(A7.6) 


V2  =  V3  Vi 


BA31 


(2  -  2BA33)  (2  -  2BA33) 


BAl=  .  ^(2  ■-. 


The  vectors,  expressed  in  the  A  frame,  form  the  columns  of  matrix  AV. 

We  see  that  AV  is  a  function  of  just  3  variables  BA  i  =>  1,  2,  3.  For 

3 ' 

the  least-squares  differential  correction  of  Process  B  we  need  the  partial 
derivatives  9AV/93j,  j  =  0,  1,  2,  3.  To  simplify  the  calculations  we 
expand  this: 


:>-»»■  SI 
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MV  -  V  3AV 


(A7.8) 


aAV 


dBA. 


3i 


IS  a  3  X  3  matrix  and  are  elements  of  a  3  x  3  matrix 


where 
3BA 

g^.  The  partial s  aAV/aBA^^. ,  after  some  algebra, are 
J 


1  1 

1 

0 

(2+2BA33)‘^"  I 

(2  - 

2BA33)'^" 

aAV  _ 

1 

n  1 

n 

1 

aBAs  1 

u  1 

1 

u 

(1  -  BAh)'^^ 

1 

0  1 

0 

0 

n  1 

0 

-1 

\j 

1 

1 

(1  -  BAh)'^" 

aAV  _ 

1 

1  1 

1 

0 

aBAs  2 

(2  +  2BA33)'^'  I 

(2  - 

2BA33)‘^' 

1 

0  1 

0 

0 

-BA31  ^  .  1 

BA31 

-BAs  2 BA 3 1 

(2  +  2BA33)'^"  1 

(2  - 

2BA33)'^" 

(1  -  BAI3) 

aAV  . 

1 

-BA 3 2  ^  I 

BA  3  7 

BA,, BA,, 

aBA3  3 

(2  +  2BA3,)'/^  I 

(2  - 

2BA33)'^^ 

(1  -  BA|3)'/=’ 

1  1 

1 

0 

2(2  +  2BA33)^^2  I 

2(2 

■  2BA33)*/2 

(A7.9a-c 


We  now  consider  in  some  detail  how  the  derivative  matrix  for  the  least- 
squares  differential  correction  is  filled  to  recover  and  3g^.  The 
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r  . 


1 

I 

I 

I 

I 

1 

I 


elements  of  the  A  matrix  for  treating  a  single  FOV  are  found  by  expanding 

J]L. 

36vn- 


3X 


36. 


VN 


_  3X  3AN 
■  3  AN  36 


VN 


[for  FOV (A)] 


=  3^  f  AV  ^ 

3AN  36wJ 


(A7.10) 


3X 


36 


VN 


3X  3BN 


3BN  36 


VN 

3BV 


[for  FOV(B)] 

=  Iw  VN  +  BV  1^)  (using  BN  =  BV  •  VN  and  BV  =  BA  •  AV) 

dm  \0Pyfj  '’^VN' 

(Bvf-).  (A7.n) 


_  3X 


3BN 


After  matching  at  least  3  stars  in  each  FOV,  we  can  combine  both  FOV 
to  recover  the  interlock  parameter  6g^  as  well  as  In  this  case,  we 
need  the  following  matrix  derivatives: 


The  elements  of  the  vectors  AX  and  AB  and  matrix  A  are: 


AX 


■(Ax.  Ay)/^ 
(Ax,  Ay)B 
1  - 

^  ■  ^BA^BA 


=  vector  of  image  residuals  for  F0V(A]r 
=  vector  of  image  residuals  for  FOV(B) 
=  constraint  condition  for  Byj^ 

=  constraint  condition  for  Bgy^ 

_ 


pByi^  =  correction  vector  for  By^j 


AB  = 


_ABg^  *  correction  vector  for  Bg^J 


3(x,  y) 

1 

A  ] 

3(x,  y) 

®VN 

'^BA 

3(x,  y) 

—  — 1 

1 

a(x,  y) 

^VN 

B  1 

^BA 

By^Wl 

1 

1 

_J_ 

0 

0 

1 

3^  wy  ^ 

Then  AB  =  (A^WA)"‘  A^WAX;  the  corrections  are  added  to  Byj^  and  Bg^ 
the  process  is  repeated  until  AB  is  small.  The  final  values  for  B^ 
passed  to  Process  C. 
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Appendix  8:  Riccati  Equation  Covariance  Propagation 

The  Kalman  filter  formulated  for  Process  C  includes  a  direct 
numerical  integration  of  the  covariance  matrix  between  two  time  points. 
This  allows  a  more  rigorous  incorporation  of  the  process  noise  component 
in  the  covariance  matrix  propagation.  Our  initial  method  was  to  compute 
the  state  transition  matrix  to  use  this  to  propagate  covariance  by  pre- 
and  post-multiplication  of  the  previous  covariance  matrix.  An  estimate 
of  the  process  noise  estimate  was  then  added  on.  We  outline  the  covar¬ 
iance  integration  technique  below. 

We  have  chosen  as  our  state  vector: 


60 

61 

62 


li 

03 

‘4  Euler  parameters,  orienting  the' 

X  = 

y 

= 

-- 

s 

vehicle  frame  with  respect  to  inertial 

bi 

frame,  N,  and  3  gyro  bias  values,  b.  . 

ba 

b3 


The  state  differential  equations  for  our  system  are: 

= 

= 

iiz)  =  {6}  =  0 


(AS.la) 

(AB.lb) 

(A8.2) 


where 
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[6] 


-el 

“Ba 

-B3 

Bo 

“Ba 

B2 

Bs 

Bo 

-Bi 

-$2 

Bi 

Bo 

0 

-0)1 

-0)2 

-0)3 

Wl 

0 

“3 

-0)2 

0)2 

-0)3 

0 

0)1 

0)3 

0)2 

-0)1 

0 

{wgj^}  =  vector  of  true  rotation  rates  of  the  vehicle 
about  three  orthogonal  body  fixed  axes, 

[VG]  =  3x3  rotation  matrix  which  rotates  the  gyro 

rates  from  the  gyro  frame  to  the  vehicle  frame. 

Our  model  for  each  gyro  measurement,  includes  an  unknown  noise 
term,  V,  and  a  gyro  bias,  bgj^,  which  we  can  estimate.  Then,  the  state 
differential  equation  for  IX i)  becomes; 

iU)  =  CevN^CVG3({wQfj}  -  {bg^}  +  {V}) 

=  [<^VN^f6vN^  ■  C^vN^CVGjibg^}  +  [evfj][VG]{V}.  (AS. 3) 

Combining  the  two  state  differential  equations,  they  can  be  rewritten  in 
a  linear  form: 

X  =  Fx  +  6v , 


1 

Fii 

1 

1  J) 

1 

1 

1  ^ 

F22 

L. 

where 


I 

I 

I 

I 

I 

I 

I 

1 

I 

] 

] 

1 

1 

1 
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1  • 

'  i 

1 

1 

-[SyHj][VG] 

1 

0 

1 

0 

Gii  1 

'^121 

[6yj^][VG]  1  0  1 

G  = 

- -| - 

II 

1 

1 

1 

1 

1 

-t- 

1 

1 

_L 

^21  1 

G22 

0  |S*[I] 

S  =  a  scale  factor  or  "tuning"  parameter. 

The  covariance  matrix  propagation  is  calculated  by  numerical  integration 
of  the  matrix  Riccati  equation: 

P  =  FP  +  PF^  +  GQG^  (A8.4) 


where  P  is  the  covariance  matrix  and  Q  is  the  process  noise  covariance 
matrix  which,  in  our  case,  represents  a  measure  of  the  noise  covariance 
between  gyro  rates  about  the  three  axes  and  between  the  three  gyro 
biases.  This  matrix  is  taken  to  be  a  6  x  6  diagonal  matrix.  In  order 
to  speed  computation  we  partition  this  equation: 


^12 
P21  P22 


Fii  Fi2 

F21  F22 

Gii  Gi2 

G21  G22 


Pii  P12 


P21  P22 


Pii  P12 


P21  P22 


f"^  f’’’ 

^11  T21 


F^  f'^ 
1-12  1-22 


Qii 

Qi2 

Q21 

Q22 

n  FgT  gT  n 

fall  fa2i 


Gi2  ^22 


Since  F21  =  0,  F22  =  0,  G12  =  0,  G21  =  0,  Q12  =  0,  and  Q21  =  0  we  can 
write  the  set  of  four  equations  implied  in  the  above  equation  as 
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^11  ®  *^12^21  ■*■  ^12^12  ■*■  S11Q11G12 

^12  *  ^11^12  ■•■  ^12^22 
^21  ~  P2ll^Il  ■•■  ^22^^12 
^22  ~  G22Q22G22‘ 

T  T  T 

Also,  since  P  is  symmetric,  P12  =  Pai*  Pii  =  Pii»  P22  =  P22  and  since 
Pii  =  [w],  which  is  skew  symmetric,  fIi  =  -Fn,  and  61  =  -Fi2-  Therefore, 

^11  =  (PiiPn  ■*■  P12P21)  (PiiPii  ^12^21)^  +  P12QP12 

^21  =  P22P12  '  ^21^11  “ 

We  must  integrate  three  matrix  differential  equations,  Pn,  P21  and  P22 
to  propagate  the  covariance  matrix.  Only  two  matrices  need  to  be 
filled  at  each  time  step  in  the  integration:  {P22  is  a  constant) 

Fii  ~ 

and 

Fi2  -[3][VG]. 

The  simplest  form  for  the  state  differential  equation  for  the  is 
then 

Currently,  we  are  using  a  two  cycle  Runge-Kutta  numerical  integration  for 
the  Riccati  equation. 

Kalman  Filter  State  Update  with  A-Priori  Information 

As  mentioned  in  the  Phase  II  report,  the  Kalman  filter,  as  formulated 
in  that  report,  did  not  estimate  the  gyro  bias  values  with  the  desired 
precision.  This  shortcoming  was  due,  in  part,  to  the  gyro  rate  noise 
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having  a  magnitude  similar  to  the  biases  themselves.  We  have  remedied 
this  problem  by  reformulating  the  Kalman  filter  to  treat  the  biases  as 
observable  with  an  associated  covariance  matrix.  Such  a  method  seems 
justified  since,  in  general,  the  biases  vary  slowly  on  the  time  scale  of 
minutes  and,  therefore,  we  would  have  some  knowledge  of  them  obtained 
from  previous  iterations. 

The  general  form  for  the  discrete  Kalman  filter  state  update  equation 
for  a  linear  system  is 

4+l(k  +  1)  =  4(k  +  1)  +  K(k  +  l)[Z(k  +  1)  -  H(k  +  l)4{k  +  1)] 

(A8.5) 

where  Z  is  the  measurement  vector  at  time  tj^^^  and  ^(k  +  1)  is  the  state, 
integrated  from  time  tj^  to  In  our  formulations,  Z  contains  the 

output  of  Process  B,  the  set  of  Euler  parameters  relating  the  V  frame 
to  the  inertial  frame,  and  the  three  bias  values  from  the  previous  pass 
through  the  Kalman  filter.  Thus,  the  observation  vector  Z  contains  the 
same  variables  as  the  state  vector  making  matrix  H  =  [I]. 

Looking  now  at  the  other  equations  for  the  Kalman  filter: 

K(k  +  1)  =  P^(k  +  l)H^(k  +  l)[L(k  +  1)  +  H(k  +  l)P,^(k  +  l)H''^(k  +  1)]" 

=  Pk(k  +  l)[L(k  +  1)  +  P^(k  +  l)]'i  (A8.6) 

where  L(k  +  1)  =  covariance  matrix  for  the  measurements  and  P|^(k  +  1)  = 
integrated  covariance  from  the  Riccati  equation.  The  upper  left  4x4 
portion  of  L  is  the  covariance  matrix  from  the  least-squares  results  of 
Process  B.  The  lower  right  3x3  portion  of  L  is  the  covariance  matrix  of 
the  gyro  biases.  This  we  have  assumed  to  be  diagonal  (gyro  biases  are 
assumed  independent);  off  diagonal  protions  of  L  are  assumed  to  be  zero. 

The  covariance  matrix  update  equation  is 
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P,^+l(k  +  1)  =  [I  -  K(k  +  l)H(k  +  l)]P,^(k  +  1) 

=  P,,(k  +  1)  -  K(k  +  l)P^(k  +  1)  (A8.7) 

Bias  Estimation  Results 

Our  simulations  indicate  that  the  formulation  discussed  above 
functions  extremely  well.  We  note  that  as  the  estimated  variance  is 
decreased  we  get  an  improvement  in  the  bias  estimate.  However,  a  stricter 
value  on  the  bias  variance  also  decreases  the  response  time  of  the  system 
in  tracking  a  bias  change. 

It  must  be  kept  in  mind  that  the  gyro  biases,  as  we  have  defined 
them,  include  not  only  true  gyro  bias  but  also  other  effects  such  as  gyro 
nonorthogonality,  gravity  or  magnetic  effects,  and  poorly  known  interlock 
angles  between  sensor  and  gyro  frames.  It  is  expected  that  on  the  short 
term  the  gyro  bias  terms  will  absorb  these  e/iAoM  and  permit  the  state 
integrations  to  yield  good  updates. 


i 

I 
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Appendix  9:  Rate  Gyro  Readout  Data  Generation 

The  simplest  or  nominal  rotation  history  for  a  satellite  for  our 
study  is  one  rotation  per  revolution  around  the  earth.  For  our  geometry 
this  would  be  rotation  about  the  92  unit  vector,  normal  to  the  orbit 
plane.  To  be  more  realistic  and  provide  a  challenge  to  the  software,  we 
have  formulated  a  more  complicated  read-out  record  for  the  gyroscopes. 

In  a  satellite  there  may  be  various  motors,  panels  and  antennae.  Each 
of  these  may  vibrate  at  various  frequencies.  Therefore,  we  have  gener¬ 
ated  gyro  rates  with  a  spectrum  of  frequencies,  phases  and  amplitudes. 

To  do  this  we  have  created  data  in  the  (Discrete)  Fourier  Transform 
space  or  frequency  space.  A  Fast  Fourier  Transform  of  the  data  yields  a 
gyro  record.  We  used  the  formula 

f.  =  e'**-^  G.  (A9.1) 

J  J 

to  generate  a  frequency  specturm,  where  G.  is  a  Gaussian  distributed 
random  number.  We  make  the  real  transform  symmetric  about  zero  frequency 
and  the  imaginary  data  anti -symmetric  in  order  yield  a  real  gyro  record. 

With  proper  scaling,  we  have  used  the  above  form  to  generate  a  gyro 
readout  every  0.5  sec.  for  each  gyro  axis. 

Proper  application  of  the  above  technique  yields  a  realistic  gyro 
record,  but  it  has  the  disadvantage  of  making  it  difficult  to  specify  a 
t^u^  rotation  and  attitude  history  for  the  spacecraft.  That  is,  Runge- 
Kutta  integration  is  designed  to  integrate  smooth  functions  whereas  this 
rate  simulation  is  discrete.  Also,  in  a  real  system  some  of  the  frequencies 
recorded  by  the  gyroscopes  are  just  vibration  or  noise  and  not  rotation. 

For  consistency,  we  decided  to  Integrate  the  gyro  record  using  two-cycle 
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Runge-Kutta  in  both  the  truth  model  programs  and  Process  C.  This  at 
least  allows  comparison  between  models  with  and  without  additional 
noise.  We  have  performed  several  tests  to  determine  the  effects  of  gyro 
noise  and  a  complicated  signal.  These  tests  confirm  our  intuition  that 
if  we  take  a  sufficient  number  of  samples,  the  rapid  zero  mean  oscil¬ 
lations  about  the  mean  motion  do  not  significantly  affect  the  integrated 
solution. 
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Appendix  10:  Software  Documentation,  Program 
Listings  and  Sample  Output 

This  appendix  is  divided  into  several  parts.  We  first  describe 
and  list  the  program  which  generates  simulated  data,  Datgen,  and  the 
program  which  processes  the  data  using  Processes  B  and  C,  Combi n . 

Then,  since  these  two  programs  have  several  subroutines  in  common,  we 
describe  and  list  all  the  subroutines  for  these  programs,  in  alphabet¬ 
ical  order.  Figures  AlO.l  and  A10.2  display  the  hierarchy  of  subroutine 
calls  for  these  two  programs. 

A  sample  of  program  output  is  presented  also. 


AD-A103  606  VIRGINIA  POLYTECHNIC  INST  AND  STATE  UNIV  BLACKSBURG  —ETC  F/6  17/7 
STAR  PATTERN  RECOGNITION  AND  SPACECRAFT  ATTITUDE  DETERMINATION. (U) 
HAY  81  T  e  STRIKMEROA*  J  L  JUNKINS  DAAK70-7B-C-0036 

£TL>0260  NL 


UNCLASSIFIED 
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Datgen 

This  program  generates  simulated  data  which  is  used  for  tests  of 
Processes  B  and  C.  The  data  for  a  sequence  of  frames  are  written  to  a 
disk  or  tape  file  for  later  analysis.  For  each  simulation  test  we  can 
select  variations  in  any  of  a  number  of  parameters.  However,  the  program 
itself  must  be  modified  to  change  the  amplitude,  period  or  form  of  the 
variation.  To  run  this  program  it  is  necessary  to  supply  a  file  con¬ 
taining  realistic  gyroscope  read-out  rates  (currently,  enough  for  15 
minutes  of  satellite  motion  with  a  spacing  of  0.5  seconds  between 
readouts),  and  a  mission  catalog  of  star  positions  (ordered  into  cells 
by  the  method  of  Appendix  3). 

To  begin  generating  data,  the  gyro  rates  and  the  table  of  star 
catalog  cell  positions  are  read  from  the  external  files.  Next,  we 
select  the  variations  we  wish  to  include  in  this  simulation.  The  earth 
and  satellite  orbit  constants  and  initial  positions  and  velocities  are 
specified  in  the  program  but  can  be  changed  if  desired.  These  orbit 
parameters,  along  with  our  assumed  geometry,  are  used  to  determine  the 
initial  orientation  of  the  vehicle  via  rotation  matrix  VN,  orienting 
the  vehicle  frame  relative  to  the  inertial  frame;  from  VN  we  recover 
the  initial  values  of  Euler  parameters,  All  constants  for  this 

simulation  are  stored  in  the  first  record  of  the  data  file  (see  Table 
AlO.l). 

We  are  now  ready  to  compute  image  coordinates  for  successive 
frames  of  data  (separated  by  30  seconds  of  satellite  motion  in  the  present 
software  version).  We  note  that  all  variations  such  as  gyro  biases 
and  coordinate  frame  perturbations  are  slowly  varying  and,  therefore. 
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the  perturbed  values  are  calculated  only  once  per  30  second  interval 
(subroutines  Bias  and  Perturb) .  For  each  frame  of  data  we  first 
integrate  forward  (via  subroutine  Runqe)  the  kinematic  equation  for 
using  the  "true"  gyro  rates,  perhaps  including  a  perturbed  rotation 
matrix  VG,  found  from  and  used  to  rotate  the  gyro  rates  from  the 
gyro  frame  into  the  vehicle  frame.  Gaussian  noise  is  added  to  the 
integrated  values  of  in  order  to  provide  an  "estimate"  of  to 
start  Process  B,  if  it  is  run  separately  from  Process  C  (see  description 
of  Combi n).  Euler  parameters  which  can  be  time  varying  and 
rotation  matrix  BA,  relating  FOV(B)  with  respect  to  FOV(A),  are  deter¬ 
mined  at  this  time  also.  We  then  compute  the  position  and  velocity 
vectors  of  the  earth  and  satellite  (with  subroutine  Orbit)  and  find  the 
total  velocity  (which  is  later  used  by  subroutine  Access  to  add  stellar 
aberration  to  star  direction  cosines).  The  various  Euler  parameters 
and  total  velocity  are  saved  in  the  first  part  of  each  data  record. 

The  next  step  is  to  calculate  image  coordinates  for  stars  in  each 
FOV.  We  calculate  rotation  matrix  AN  (or  BN  for  FOV(B))  using  subroutines 
Pi rcosb  and  Mat-av,  and  use  the  last  row  as  the  boresight  unit  vector  of 
the  star  tracker.  This  unit  vector  is  used  by  Access  to  retrieve  a 
subcatalog  of  stars.  Each  star  is  then  projected  onto  the  focal  plane 
(via  Phoeqn ) ;  if  it  lies  within  the  CCD  border,  we  save  its  position 
and  magnitude.  These  "true"  positions  are  then  perturbed  with  Gaussian 
noise  (subroutine  Gauss)  to  produce  "measured"  star  coordinates  (up 
to  10  stars).  The  steps  outlined  above  are  repeated  for  FOV(B). 

Both  the  true  and  measured  image  coordinates  and  magnitudes  are  saved  on 
the  data  file. 
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The  last  step  in  each  frame  is  to  add  noise  and/or  bias  values  to 
the  rate  gyro  data  (for  that  frame)  and  save  the  results  on  the  data 
file  (see  Table  A10.2).  Sufficient  space  is  left  between  the  end  of 
this  information  and  the  end  of  the  record  so  results  of  the  analysis 
of  Processes  B  and  C  can  be  saved  for  later  evaluation. 


Orbit 


Table  AlO.l:  Format  of  First  Record  of  Simulation  File 


Variable 

Size 

Locations 

Satellite  orbit  major  axis 

1 

1 

G*(mass  of  earth) 

1 

2 

Initial  satellite  position 

3 

3-5 

Initial  satellite  velocity 

3 

6-8 

Earth  orbit  major  axis 

1 

9 

G*(mass  of  sun) 

1 

10 

Initial  earth  position 

3 

11-13 

Initial  earth  velocity 

3 

14-16 

Satellite  orbit  inclination 

1 

17 

Image  centroid  error  (1 -sigma) 

1 

18 

Image  magnitude  error  (1-sigma) 

1 

19 

Euler  parameter  error  (1 -sigma) 

1 

20 

Gyro  rate  error  (1 -sigma) 

1 

21 

Gyro  read-out  spacing 

1 

22 

Starting  time  (seconds) 

1 

23 

Frame  spacing  (seconds) 

1 

24 

Nominal  interlock  Euler  parameters  Sg* 
Variation  amplitudes  " 

4 

25-28 

4 

29-32 

Variation  frequency  factors 

4 

33-36 

Nominal  gyro  biases 

3 

37-39 

Variation  amplitudes 

3 

40-42 

Variation  frequency  factors 

3 

V  43-45 

Nominal  interlock  Euler  parameters  3yg 
Variation  amplitudes 

4 

46-49 

4 

50-53  ' 

Variation  frequency  factors 

4 

54-57 

Weight  for  apriori  Euler  parameters  6g. 
Standard  deviation  for  gyro  biases  ^ 

1 

58 

1 

59 

Process  C  I  Process  B  j 

Output  Data  |  Output  Data  Simulation  Program  Output  Data 
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Table  A10.2:  Format  of  Data  Records  of  Simulation  File 


Variable 

Size 

mmm 

(true) 

4 

8 

1-4 

(estimated) 

4 

8 

5-8 

Byg  (true) 

4 

8 

9-12 

Byg  (estimated) 

4 

8 

13-16 

4^ 

Bba  (true) 

4 

8 

17-20 

4-> 

Bg^  (estimated) 

4 

8 

21-24 

3 

Q. 

Velocity  components 

3 

8 

25-27 

O 

£ 

No.  stars  in  FOV(A) 

1 

8 

28 

s_ 

{(x.y.m)}  (true) 

10  X 

3 

4 

29-58 

C7» 

o 

s.. 

{(x,y,m)}  (measured) 

10  X 

3 

4 

59-88 

CL 

No.  stars  in  FOV(B) 

1 

8 

89 

o 

{(x,y,m)}  (true) 

10  X 

3 

4 

90-119 

4-» 

*0 

{(x,y,m)}  (measured) 

10  X 

3 

4 

120-149 

3 

E 

Rate  gyro  data  (on) 

61 

4 

150-210 

00 

Rate  gyro  data  (oja) 

61 

4 

211-271 

Rate  gyro  data  (003) 

61 

4 

272-332 

Gyro  biases  (true) 

3 

8 

333-335 

^VN  ^ 

4 

8 

336-339 

fO 

Bg^  (calc.) 

4 

8 

340-343 

“S 

Covariance  matrix  for  (calc.) 

4  X 

4 

4 

344-359 

wi 

0)  3 

No.  stars  matched  in  FOV(A) 

1 

8 

360 

O  4-> 
i-  3 

{(x,y)}  (calc.) 

5  X 

2 

4 

361-370 

a.  o 

No.  stars  matched  in  FOV(B) 

1 

8 

371 

{(x,y)}  (calc.) 

5  X 

2 

4 

372-381 

Bym  (optimal  estimate) 

4 

8 

382-385 

<0 

4-» 

O  ro 

Gyro  biases  (optimal  estimate) 

3 

8 

386-388 

c3 

4/> 

3wki  (integrated  from  previous 

</)  4-’ 

value) 

4 

8 

389-392 

U  O. 

Covariance  matrix  for  Bwm 

W  3 

a.  o 

(opt.  est.) 

4  X 

4 

4 

393-408 

I 


«•«**'»*««««*>•»»»»*■»»««'»«•»*«**•**«*«***««»«•*****•*******«**•« 
*  * 

*  PF:OGR«M:DflTCEN  * 

*  « 


80  !  This  program  computes  data  for  Processes  B  and  C.  Data  consist  of  Euler 

90  !  parameters,  s.ssorted  other  parameters,  and  image  coordinates  for 

100  !  both  fields  cf  uiew. 

110  !  We  use  E.4ler  parameters  in  this  version  to  orient 

120  !  the  7  frame  relative  to  inertia!  frame  and  FOV<B>  u.r.t.  FOV<fl). 

130  !  Tom  ijtr  i  tuerca.  .  .  V.  P.  I .  t<  S.U . 14  JPNUPRY  1981« 

140  ! 

150  OVERLAP 
160  OPTION  BASE  1 
170  FLOAT  !5 

180  DIM  An;3,3>,Gn<3,3),Ba<3,3>,Bn<3,3),Av(3,3>,Vg<3,3>,Vn(3,3) 

190  DIM  G1 ;3), G2<3),G3<3),Bore<3> 

200  DIM  Psi3<3),Vs0<3),Ps<3),Vs<3>,L<3>,Lp(3>,Bias<3> 

210  DIM  PeU<3),Ve0<3),Pe<3),  Ve<3>,.V<3),Vv<3>,Xn<3>,  Voc(3> 

220  DIM  Bvn<4) , Bvnest < 4) , Evg<4 ) , Bba(4> 

230  SHORT  :<ym<l(i,3),Xvt<10,3),Fov<100,4> 

240  SHORT  !3ban3m<4>  ,  Bi  asnom<3> ,  GyronomO) ,  Bvgnom(4> 

250  SHORT  livgC  4:  ,  Nc  g< 4 )  ,  Eba< 4  >  ,  Nba<4>  ,  Ebi  as< 3 >  ,  Nb i  as  ( 3 > ,  Eg>^ro< 3 ) ,  Ngyrot  3  ) 

260  SHORT  W1<23<8),W2<2048>,WS<2048>,R1<61>,R2<61>,R3<61> 

270  INTEGER  TaDle<529,2) 

280  RANDOMIZE 
290  ! 

300  Wread"!} 

310  Restart;  !  Come  here  to  do  another  run. 

320  PRINT  USIn:  " K " ; " PROGRAM  DATGEN  «*#***#*«*##" 
330  ! 

340  N»="N" 

350  INPUT  'Do  k'C'U  uant  to  use  realistic  gyro  rate  history  <Y/N>?",Ni 

360  PRINT  USINj  "/k,  A";"Do  you  want  to  use  realistic  gyro  rate  history  lY-'N'? 

" ;  H$ 

370  ! 

380  IF  N$<>"Y"  THEk  Plain_rates 

390  IF  Wread*!  1  HEk  Star_cat 

400  PRINT  USINj  "/K"; "Place  disk  with  gyro  rates  <Fi lename; 'Wtrue' >  in  :F8,1.. 
...then  push  CONT. " 

410  PAUSE 

420  ASSIGN  «1  TO  "ktruelFS,!" 

430  DISP  "Readirig  rate  gyro  hi  story. ...  PI  ease  wait." 

440  READ  «( ;W1 >,k2(*},U3(*> 

450  ASSIGN  «1  TO  • 

460  Wread>l 
470  DISP 
480  GOTO  S^ar  rat 
490  “l 

500  Plain  ra"es:  ! 

510  MreId-0 
520  MAT  Ul'ZER 


I  On*  rotation  »o*r^  90  minutas 


530  MAT  W2«<2*^l/'5400> 

540  MAT  W3«2ER 

550  t 

560  Star_<:*t:  ! 

570  PRINT  iJSINj  'Vk/K" ;  "Pi  ace  star  catalog  disk  (Filenames:  'Tab22'  and  'I1iss2 
20')  in  ;F8, 1. .then  push  CONT." 

580  PAUSE 
590  ! 

600  N**"N“ 

610  INPUT  'Has  Table  of  star  catalog  cell  positions  been  read-in  <Y/N)?",N$ 

620  PRINT  IJSINj  "/'K,A";"Has  Table  of  star  catalog  cell  positions  been  read-in? 

<V/N)  "INS 

630  I 

640  IF  N»< >"N"  THEF  Haue_table 

650  ASSIGN  ill  TO  "  T  ab22 :  F8,  I  " 

660  READ  ill,  1 

670  READ  ill;Ta3le<«>  !  Read  in  table  of  cell  positions. 

680  ASSIGN  ill  TCI  *  I  Close  this  file. 

690  ! 

700  Have_table:  !  Come  here  if  table  has  been  read-in. 

710  ASSIGN  «1  TO  “I'ss220:  F8,  1“ 

720  ! 

730  Num=30  !  Number  of  records. 

740  Len=20l8  '  Bytesrrecord. 

750  Fn4="BCdat a: F8, 1 "  !  Dummy  file  name. 

760  INPUT  'Fil»  nanre  for  simulation  run  < 'Si  mnnn:  F8,  1 '...  where  nnn  is  3  num.): 
" ,  Fn* 

770  ON  ERROR  GTTO  Error 

780  PRINT  IJSINj  "/KrK";"File  name  for  simulation  run  < 'Si  mnnn:  F8,  I ' . .  .  wiere  nn 
n  i  s  3  num.  ) : " ,  Fil- 
790  ! 

800  Done*.  ! 

810  ASSIGN  i2  rCi  Fr$ 

820  CHECK  READ  12 
830  OFF  ERROR 
840  GOTO  Ok 
850  ! 

860  Error:  I 

870  PRINT  IJSINj  ">'K";ERRM$ 

880  IF  ERRH055  THEN  STOP 

890  INPUT  'Shojid  I  create  this  file  for  you?*',N$ 

900  N$*"N" 

910  PRINT  IJSINj  "rK,K";  "Should  I  create  this  file  for  you?  ",N$ 

920  IF  N^s’-N"  THEN  STOP 
930  CREATE  Fn$,Hum,Len 
940  GOTO  Done 
950  ! 

960  Ok:  ! 

970  READ  #2,1  I  Position  pointer  at  beginning  of  file. 

980  File-1 
990  • 

1000  Continue:  ! 

1010  !  Set  satellite  orbit  parameters. 

1020  '  See  write-up  on  "Orbit"  for  expl ai nat i on. 

1030  As-6652.56  !  Satellite  major  axis. 
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1040 
1050 
1060 
1070 
1080 
1090 
1100 
1 1 10 
1120 
1130 
1140 
1150 
1160 
1170 
1180 
1190 
1200 
1210 
1220 
1230 
1240 
1250 
1260 
1270 
1280 
1290 
1300 
1310 
1320 
1330 
1340 
1350 
1360 
1370 
1380 
1390 
1400 
1410 


Us=631 , 3487 
Us>:Us*iJs 
Inc  J  *7:5 

Ps0<  1  )  «fls 
Ps0<2)==0 
Ps0<3) =0 


G*M. 

Incl  is  satellite  inclination  in  degrees. 
Initial  position  of  satellite  (km>. 


Vs0< 1 ) =0 

Vs0<2)  =7. 74ti6*C0S<  Inc  1  *FI/180>  !  Set  initial  satellite  velocity  (kn/sec). 

Vs0<3)  =7. 7  4tt6*S  IN<  Inc  1  ePI/ieO) 


Rs0=SQI?(DOT<Psg,Ps0)) 

Vsi  =SQI?< DO r<  VsC  ,  Vs0) )  !  Constants  needed  by  Orb i  t . 

Ds0=DOr<Ps3,Vse) 

flssl/<;2/Rs3- VsieVsi  /Us) 

Per  i  od  =SQR(fis/L  s)*Fls*2*F' I 

PRINT  iJSIN:  Form4; "Period  Period/60, "mi nutes" 

I 

!  Set  parameters  for  earth  orbit. 

fle=l . 495973710E8  !  Earth  orbit  major  axis  (km). 

Ue*3.642972(;85E5 
Ue*Ue»tJe 

Ve0=29 . 78459848  !  Total  earth  velocity  (km/sec). 

Earth  i nc 1 *23.5 


Pe0<l ) =-fle 


Pe0<2) 

Pc0<3) 

V€0<  1 ) 
Ve0<2) 
Ve0<3) 


S0 
=  0 


Pvt  earth  at  vernal  equinox  for  initial 
position  (km). 


=  Ve0»C;OS(-Earth_incl  ♦PI/180> 
sVe0»SIN(-Earth  i nc 1 ePI/lSO) 


Initial  earth  velocity  (lm/sec>, 
Earth  is  heading  downward  ir 
inertial  Frame. 


Re0=SQR(DOT<  Pee ,Pe0) ) 
Vei =SQR(D0r<  VeC , Ve0) ) 
De0  =  DO  r(Pe3, Vee ) 
fle=l/(.2/Re3-  Vei*Vei  /Ue) 


Constants  needed  by  Or b i t , 


1420  ! 

1430  C=3E5  !  C=VeIocity  of  light  (km/sec). 

1440  Del =4. 348E -6  !  =  1  arcsecond  in  radians. 

1450  0mega*;2*P  I /F'er  i  od  !  Angular  frequency  of  satellite  (rad/sec). 

1460  ! 

1470  !  Conrpute  various  Euler  parameter  values. 

1480  ! 

1490  !  Euler  parameters  relating  vehicle  and  gyro  frames. 

1500  MAT  Bvgnom=I!ER 

1510  Bvgnom:i)=l  !  Nominal  values. 

1520  ! 

1530  MAT  Ev.j»ZER 
1540  N«-"N" 

1550  INPUT  'Do  .»c*u  i.ant  variations  in  Euler  para,  relating  V  frame  to  Gyro  fram 
e  (Y/N)?",N$ 

1560  PRINT  iJSINj  "/k,A’';"Do  you  want  variations  in  Euler  para,  relating  V  frame 
to  Gyro  frame  ''I’/N)'  ’’,N* 
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1570  IF  THEN  Ho  og 

1580  Ewg<l>=D#1 

1590  E<.'g<2>  •-2*0«  I  I  RmpHtud*  of  OAriations  (radiani). 

1600  EMg<3)«3*Dil 
1610  Evg<4)«4*D»l 

1620  I 

1630  Nwg<l):=3 

1640  H<><g<2)»4  !  Frequency  of  uariations. 

1650  Nug<3)=5 

1660  Nug(4><:6 

1670  ! 

1680  No_vg:  ! 

1690  !  Courpute  the  orientation  of  F0V<B>  w.r.t.  F0V<fi>. 

1700  ! 

1710  Ebariom:i)  =  l/SQF<2)  !  SQR<  tySQR<2>  +  l  >^2 

1720  Bbanom ;2)  =  1' SQF <2)  IBbanomtl)  '  Nominal  values. 

1730  Bbanom;3)=3  ! l/<SQR<2>*4*Bbanom< 1) ) 

1740  Bbanomv4>  =  3  !6banoin<3> 

1750  ! 

1760  MAT  Eb»=2E? 

1770  N*="N" 

1780  INPUT  'Do  .^ciu  uant  variations  in  Euler  para,  relating  B  frame  to  A  frame  < 
Y^N>?",N$ 

1790  PRINT  IJSIN3  "^K,K";"Do  you  want  variations  in  Euler  para,  relating  I  frame 
to  A  frame  ;Y/N>?  " , N* 

1800  IF  N»=’N"  THEN  No  ba 

1810  Eba<  1  )  --10*O€  I 

1820  Eba<2)''-30»Iiel  !  Amplitude  of  variations  (radians). 

1830  Eba<3)-20»O< 1 

1840  Eba(4)'<5»D?l 

1850  * 

1860  Nba<l>*2 

1870  Nba<2>'»3  !  Frequency  of  variations  <  Osc  i  1  1  ai  ons^orb  i  t ) . 

1880  Nba<3)-=5 

1890  Hba(4>^*4 

1900  ! 

1910  No_ba:  ! 

1920  !  Set  gyro  bias  values. 

1930  MAT  Biasnon=ZER 
1940  MAT  Ebias*2£:R 
1950  Bias*»'N" 

I960  INPUT  'Do  ,^C'U  uant  time  varying  gyro  biases  (Y^N)?  ",Bias* 

1970  PRINT  IJSINj  "/K,K";"Do  you  want  time  varying  gyro  biases  <Y^N)?  ",Bias# 
1980  IF  Bia:>««’'4'  TFEN  No  bias 
1990  ! 

2000  6i  asnoiA(  1 )  3-'Del 

2010  Bi  asnom<2)  =2*D€  1  !  Nominal  values  for  biases  (radi  ans/'sec  ) . 

2020  Bi asnom<3) 3«Ze I 
2030  ! 

2040  Ebi  as<  I  )»Bi  <tsncm(  1  )/'2 

2050  Ebi as<2)*-Bi asr om<2)/3  I  Amplitude  of  variations  (radi ans^sec ) . 

2060  Ebi  as<3>«Bi  jisncm<3)/'4 
2070  ! 

2060  Nbias(l)a4 

2090  Nbias<:2)*6  I  Frequency  of  variations  (Osc  i  1 1  at  i  ons-'orbi  t ) . 
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2iee  Nbi«s()>-8 
2Ue  ! 

2120  Mo  bi«s;  !  Set  oarious  constants. 

2130  ~  ! 

2140  SigxyB3.4E-3  !  Standard  deviation  of  image  coordinates  in  mm. 

2150  Sigm«.05  !  Sigm  is  the  deviation  in  magnitude. 

2160  ! 

2170  Xynoi  Si»$»“  i” 

2180  INPUT  'Do  ,^ou  uant  to  add  noise  to  image  coordinates  < Y/N>?" , Xyno i  se * 

2190  PRINT  iJSINj  "/'K,fl";"Do  you  want  to  add  noise  to  image  coordinatesCY  N)?",X 
ynoi set 

2200  IF  Xynoiset* "N"  THEN  Sigxy»0 
2210  ! 

2220  FI *72. 425  !  Focal  length  of  star  sensor  lens  <mm>. 

2230  Sigb«P(/'189  !  Standard  deviation  in  Euler  parameters.  This  is  used 

2240  !  if  Process  B  is  to  run  separately. 

2250  ! 

2260  Siggy«l  !  Standard  deviation  of  gyro  noise  (degrees^hour > . 

2270  Si ggy>:»i  gg.'4'PI^  <  180*3600)  !  <rad. /’second) 

2280  I 

2290  Gyro«-'N" 

2300  INPUT  'Do  ,<ou  uant  noise  added  to  rat*  gyro  dat  a(  Y/N)?" ,  Gyr  ot 

2310  PRINT  IJSINj  ''/l(,R";”Do  you  want  noise  added  to  rate  gyro  data  C  Y/'N) ' " ,  Gyro 

$ 

2320  IF  Gyro$=">l'  TFEN  Siggy=0 
2330  ! 

2340  Sigma>i) 

2350  Radi  us'»6*P  I  /  18C  !  fingle  from  FOV  center  for  accepting  catalog  stars. 

2360  < 

2370  PLOTTER  IS  ' GRFPHICS" 

2380  LORG  5 
2390  ! 

2400  !  Get  the  initial  gyro  orientation  w.r.t.  the  inertial  system. 

2410  ! 

2420  T0=0  !  Set  reference  time. 

2430  Tim*=0  !  Set  initial  time  (seconds)  for  this  run. 

2440  ! 

2450  CALL  Orbi  t  CTim€,Ps<*),Vs<*),Ps0<:*),Vs0<*),T0,Us,fis,Ds0,Rs0> 

2460  PRINT  IJSINj  For  m  I ;  "Pos  i  t  i  on  <km)  and  velocity  (km/sec)  of  Sat  e  1  1  i  t  e :  "  ,  Ps  <  * 
), Vs<*) 

2470  ! 

2480  Sc“SQR JDOTCPs, Fs) )  !  Normalize  the  satellite  positior. 

2490  MAT  G3'*Ps/'<Sc)  1  G3  is  along  position  vector. 

2500  CALL  Cross<C;2(* ) ,  C3<») ,  Vs<#) )  <  G2  is  normal  to  orbit  plane  defined 

2510  G2sSQR ;  D0T<C;2,  C2) )  !  by  position  and  velocity  vectors. 

2520  NAT  G2^>G2/<(:2)  •  Normalize  G2. 

2530  CALL  Ci'oss<Cil<«),G2<»),G3(*))  !  Cl  -  G2  cross  G3. 

2540  ! 

2550  FOR  I*l  TO  3  (Fill  the  Gn<#)  rotation  matrix. 

2560  Gn(l , I)a jl <I) 

2570  Gn<2.  I)«  j;:<I) 

2580  Gn(3,  I)- j:i(l) 

2590  NEXT  I 
2600  ! 

2610  PRINT  IJSINj  Form2;  "Matrix  GN;",Gn<e> 


!  Normalize  the  satellite  positior. 

I  G3  i s  along  position  vector. 

<  C2  is  normal  to  orbit  plane  defined 
!  by  position  and  velocity  vectors. 

!  Normal i ze  G2. 

!  Cl  ■  G2  cross  G3. 

•  Fill  the  Gn<#)  rotation  matrix. 
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2620  < 

2630  !  Coif  put  e  Euler  parameter*  for  VN  rotation. 

2640  I  First  get  true  Euler  parameters  for  VC  rotation. 

2650  i 

2660  CfiLL  P.frt  u"ti<  B'. gnom<  * ) ,  Eug<  *  > ,  Nug<e>  I  Omega,  0,  Bug(  ♦> ) 

2670  PRINT  iJSINj  For  m3; "Bug. . . nomi nal  Euler  Parameters  between  frames  V-G : " , Bug 
nom<  *) 

2680  PRINT  IJSIN3  For  m3; “Bug. .. true  Euler  Parameters  between  frames  V-G:",Bug<*) 
2690  ! 

2700  CRLL  Dtrcoit.(Bug<*),Vg<*)) 

2710  ! 

2720  MAT  Vn»Vg*jr. 

2730  i  Recouer  Euler  parameters. 

2740  Bun<n  >.5*3C!R<Vn<l,  0+Vn<2, 2)+Vn<3, 3)  +  l  > 

2750  B0*Bun'.  1) 

2760  Bun<2>  «':Vn<i;,3>-Vn<3, 2)  )/'<4*B0) 

2770  Bun<3) ’(VnCi,  1  )-Vn<  1 ,3)  )^<4*B0) 

2780  Bun<4) *<Vn<l ,2)-Vn(2, 1))/<4*B0) 

2790  I 

2800  PRINT  IJSINI  For  m3;  "  Bun.  .  .  Ini  t  i  al  Euler  Parameters  between  frames  V-i- :  "  ,  Bun 
<♦> 

2810  > 

2620  ! 

2830  Step  =  3'ii  !  seconds  between  frames. 

2840  Belt*. 5  !  seconds  between  gyro  readouts. 

2850  ! 

2860  '  Saue  all  constants  for  this  run. 

2870  PRINT  42,  1 ;  fis ,  L s ,  Ps0< ♦ ) ,  Vs0< * ) ,  Re ,  Ue ,  PeOG* > ,  V€0< * ) ,  Inci ,  S i  gxy ,  S i  gm ,  £  i  gb,  S i 
ggy ,  De  1 1 ,  T  i  m<? ,  St  »p 

2880  PRINT  42;  Boanoir  <*) ,  Eba<* ) ,  Nba<*) ,  Bi  asnom<« ) ,  Eb i  as< *) ,  Nb i  as< ♦) ,  Bugnon  (*) ,  Eu 
g<*),Nug<*) 

2890  ! 

2900  !  Nou  generate  frames  of  data. 

2910  I 

2920  Time  loop:  I 

2930  1 1=0 

2940  FOR  It'*2  TD  30  !  number  of  frames. 

2950  1 

2960  DISP  ’  FR8ME:  ";  It 

2970  ! 

2980  PRINT  USI-IC;  K,  DP,  K ";"  ****♦♦**♦♦  FRAME  :",It,"  ***♦•♦*♦***♦" 

2990  1  Locp  ouer  time  interual  to  get  true  gyro  rates. 

3000  FOR  J=1  T3  Step/Delt+1 

3010  R1 <  I>=W1 < I i + J) 

3020  R2< J)=W2( I i + J) 

3030  R3<.I)=W3<  I  i  +  J) 

3040  NEXT  J 
3050  ! 

3060  I i»I i rSteo^ Del t 
3070  Dt*TiMe-T3 

3080  !  Conpute  the  VC  Euler  parameters. 

3090  CRLL  Per t  .tr  bi', iugnom< *),  Eugt* ),  Nvg<»>  , Omega,  Dt ,  BugC *>  > 

3100  CRLL  :3i  rc  3£  b<  Iug<  *)  ,  Vg<  *)  > 

3110  PRINT  USHCi  Fcrm2;  "Matr  i  X  VG:",Vg<*) 

3120  !  Call  Runge-Kutta  to  compute  true  ualues  uehicle  frame.  tWe 


3130  !  keep  VC  fixed  during  this  time  interval.) 

3140  CALL  Runget  Bur  <*>  ,  Ti  me,  Delt ,  Step,  R1  (*>  ,  R2i:*>  ,  R3<*>  ,  Vg(*>  > 

3150  ! 

3160  PRINT  USI'IC  Fcrm4;  "Satell  i  te  time  from  start  of  simulation:  "  ,  Ti  me,  "secon 
ds" 

3170  PRINT  USI4Ci  Fcrm3; "Bun. .. True  Euler  Parameters  between  frames  V-N:",Bvn(* 
) 

3180  j 

3190  CALL  :3irc3S.b<Ivn<*),Vn<*)) 

3200  !  Perturb  Beta^BR)  about  their  nominal  values. 

3210  CALL  Pert jrb<Ibanom< *), Eba<e> , Nba(*) , Omega, Dt , BbaC*) ) 

3220  CALL  3i  rc  3i.b<Iba<e>  ,  Ba<*>  >  !  Compute  rotation  matrix. 

3230  ! 

3240  PRINT  USlSCi  Fcrm3; "Bba. . .Nominal  Euler  Parameters  between  frames  B-A:",Eb 
anom<*) 

3250  PRINT  USMCl  Fc rm3 Bba. .. True  Euler  Parameters  between  frames  B-A:  " ,  Bba'.* 
) 

3260  ! 

3270  CALL  :)i  rc  3S.b<Iba<*)  ,  Ba<*)  > 

3280  ! 

3290  PRINT  USHCi  Fcrm2;  "Matr  i  x  BA  :",Ba<*) 

3300  ! 

3310  CALL  l1at_av<Be.<*) ,  Av<*) ) 

3320  !  Conpute  AN  rotation  matrix. 

3330  MAT  An*Av»Vn 

3340  !  Upcate  the  satellite  and  earth  position. 

3350  CALL  Orbi  t  (  T  i  ff  e ,  Ps <  *  )  ,  Vs< *  )  ,  Ps0< ♦  )  ,  Vs0 <  * >  ,  TO ,  Us ,  As ,  Ds0,  Rs0 ) 

3360  CALL  Orbi  t  <  T i  tt e ,  Pe < *) ,  Ve<* > ,  Pe0<*) ,  Ve0< *) ,  T0,  Ue ,  Ae,  De0,  Re0) 

3370  ! 

3380  PRINT  USHCi  Fermi ;  "Posi  t  i  on  <km>  and  velocity  (km/sec)  of  Sat  e  1  1  1 1  e  :  " ,  Ps  ( 
e), Vs<e) 

3390  PRINT  USHCi  Fermi  j  "Posi  t  i  on  Ckm)  and  velocity  Ckm/sec)  of  Eart  h:  "  ,  Fe<  * ) ,  V 
e<*) 

3400  ! 

3410  MAT  V»Vs+V»  !  Compute  total  velocity. 

3420  ! 

3430  PRINT  IJ3IN3  Forml;"Total  velocity  of  satellite  <k  m/sec  >;",  V  (♦  > 

3440  ! 

3450  Mag»SQR<DOr< V, V)) 

3460  MAT  Voc-V/'CC  ) 

3470  ! 

3480  FOR  I  =  l  TO  c-  1  Perturb  Euler  parameters. 

3490  CALL  Gau  s<.  <  S  i  gb,  Bvn<  I  )  ,  Bvnest  <  I  >  >  !  These  are  used  if  only  Proc.  B 

3500  NEXT  I  !  is  run. 

3510  I 

3520  Mag«SQR< DO r< Bvrest , Bvnest > >  !  Normalize  Euler  parameters. 

3530  MAT  Bvitest  sBvnest/CMag) 

3540  ! 

3550  File»File+l 


3560 

PRINT 

42,Fi le 

1  Position  file  pointer. 

3570 

PRINT 

42;  Bv>ri<*) 

!  Save 

true  Euler  parameters. 

3580 

PRINT 

42; Finest  C*> 

1  Save 

estimated  Euler  parameters. 

3590 

PRINT 

42;Bjg<*) 

!  Save 

Betas  for  frame  G  to  Vtivg. 

3600 

PRINT 

42;Bjg<*) 

!  Save 

estimated  Bvg. 

3610 

PRINT 

42; BoaC*) 

!  Save 

Betas  for  frame  A  to  B  -  Bba 
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3620  PRINT  t2;B}a(*>  !  Saue  BbaCest.). 

3630  PRINT  ■♦2;V<*)  1  Saw#  velocity  vector. 

3640  I 

3650  GCLEPR 

3660  LOCATE  10, 110, :0, 100 
3670  I 

3680  Pass*0 

3690  Pass  2:  !  Come  here  for  F0V<B) — Second  pass  through  loop. 

3700  “  ! 

3710  SHOW  -!5. 7,  5.  7, -4. 4, 4. 4 
3720  CLIP  -5.7, 5. 7, -4. 4, 4. 4 
3730  FRAME 
3740  AXES  1,1, 0,(1 
3750  ! 

3760  FOR  J*l  TO  3 

3770  Bore ;  J)*lri<3,  J)  !  Boresight  direction  cosines. 

3780  NEXT  J 
3790  ! 

3800  PRINT  MSIN:  For»2; “Mat r i x  AN:“,An<*> 

3810  PRINT  iJSINl  Form2; "Boresight  unit  vector; ", Bore<*> 

3820  ' 

3830  CALL  fl-;ces  J<  *  1 ,  Fov <  #  >  ,  Nf  ov.  Bore <  *> ,  Si  gma,  Radi  us ,  F 1  d,  Tab  1  e < ♦  >  ,  Voc  <  ♦>  ) 
3840  • 

3850  Nni>0 

3860  PRINT  IJSINI  Form4;  "Number  of  stars  from  the  cat al  og: " ,  Nf  ov 

3870  MAT  Xy;»2E? 

3880  MAT  Xym»2E? 

3890  • 

3900  FOR  N«  I  TO  Hfo‘,  !  Find  stars  that  arc  within  FOV. 

3910  FOR  I»1  ro  3 

3920  L<  I)*F3v<N, J) 

3930  NEXT  J 

3940  call  Pho?c|n<L  <*)  ,  An<*)  ,  Xx,  Yy  )  !  Compute  x,y. 

3950  Xx»X:<*Fl 

3960  YyoYvitFl 

3970  IF  A3S<X<:>5.7  THEN  Skip  !  Test  for  star  in  field. 

3980  IF  A.3S<Yv:>4.4  THEN  Skip 

3990  ! 

4000  Nm=Nin+l  !  Got  one  I 

4010  Xyt<Hra,l>=Xx 

4020  Xyt<Nm,2)-Yy 

4030  CALL  Gauss <Sigxy,0,X)  !  Apply  noise  to  positions. 

4040  Xym(Nm,  1  )*’XxtX 

4050  CALL  Gauss <Sigxy,0,Y) 

4060  Xym<Hm,2)«’Yy»Y 

4070  Mt«Fov(N,<)  I  Save  the  magnitude. 

4080  Xyt<Nm,3>-Mt 

4090  CALL  Gauss (Si gm, 0, Dm)  !  Add  noise  to  magnitude. 

4100  XyM<Nm,3>*'MttDm 

4110  ! 

4120  MOVE  Xym(Hm, l),Xym<Nm,2) 

4130  LABEL  USING  !  Plot  the  star  position. 

4140  IF  Nm>10  THEh  Output 

4150  Skip;  I 

4160  NEXT  N 
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4170  ! 

4180  Output:  ! 

4190  PRINT  IJSIN3  ForM4;  "Humber  of  stars  in  this  F0V:",Hm 
4200  PRINT  IJSIN3  Form2;  "True  image  coordinates  <mtn) :  "  ,  Xyt  <*) 

4210  PRINT  IJSIN3  For  m2; "Measured  image  coordinates  <mm) : " , Xym< * ) 

4220  ! 

4230  PRINT  42; Nfl  !  Saue  number  of  stars  in  ficic. 

4240  PRINT  42; X^t <*> , Xym<* >  !  Saue  true  and  measured  positions. 

4250  ! 

4260  MRT  6n>Ba*^ri  I  Rotate  to  F0V<B>. 

4270  MAT  An=Bn 

4280  LOCATE  10, 110, C, SO 

4290  ! 

4300  Pass»Pass+l 
4310  IF  Pas:s>l  THEN  Na^Nm 

4320  IF  Pas;»»l  THEN  Pass_2 

4330  ! 

4340  IF  Gyro»»“4'  TFEN  Skip_noise 

4350  OISP  "Adding  nc i se  to  gyro  rates. . .please  wait." 

4360  !  ' 

4370  FOR  J«l  TO  Step/Delt 
4380  CALL  Gausi (S i ggy , 0, X> 

4390  R1<J»=R1  <.")+> 

4400  CALL  Gauss < S i ggy, 0, X) 

4410  R2<j)=R2  <:.;•)+>< 

4420  CALL  Gau ss (Si ggy , 0, X) 

4430  R3<  J  >»R3 (.;  )+>■ 

4440  NEXT  J 
4450  ! 

4460  Skip_noise:  ! 

4470  IF  Bias$*"')'  THEN  Skip_bias 

4480  !  Calculate  the  bias  rates. 

4490  CALL  Bi  as< Dt , Bi asnom<e ), Ebi as (♦>, Nbi as(* >, Omega, Bi as< *> ) 

4500  PRINT  USING  Form3; "Bi ases. . . true  ual uesl " , Bi as<*> 

4510  MAT  Rl=Rl-t  (Biasd)) 

4520  MAT  R2»R2t <Bias<2)) 

4530  MAT  R3-R3^•<Bias<3)) 

4540  Skip_bias:  ! 

4550  ! 

4560  OUTPUT  0  USING  "K, DD, K, DD, XX, DD" ; "Frame:  ",It,"  Number  of  stars:  ",Ka,Nm 

4570  DISP 

4580  ! 

4590  PRINT  R1 < *) , R2<*) , R3<*)  !  Saue  measured  gyro  rates  (60«3> 

4600  PRINT  42;Bias<«)  I  Saue  true  bias  ualues  <3>. 

4610  ! 

4620  NEXT  I; 

4630  ! 

4640  ASSIGN  *  TO  *2 

4650  I 

4660  N«-"N' 

4670  INPUT  "Do  you  want  to  do  another  run<Y/N>?" , N* 

4680  PRINT  USHC;  "^K,K";"Do  you  want  to  do  another  run<Y/'N>?  ";N» 

4690  IF  N$«"Y"  THEk  Restart 
4700  I 

4710  Forml:  IMAIE:  K/ 3(3<M0.  DDDDE,  X>/> 
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Combi n 

This  program  analyses  data  produced  by  simulation  program  Datgen, 
directing  the  data  to  subroutines  for  Process  B  (Proc-b)  and  Process  C 
(Orbit,  Runge  and  Kalman).  Process  B  and  Process  C  can  be  run  separ¬ 
ately  (Process  C  alone  only  if  Process  B  was  run  previously  with  these 
data)  or  they  can  be  run  together.  Combi n  requests  several  parameters 
from  the  user:  1)  the  process  noise  standard  deviation  associated  with 
the  variation  in  interlock  Euler  parameters,  used  in  Kalman  filter 
update  of  (see  Section  3  of  the  Final  Report),  and  2)  the  gyro  bias 
"standard  deviation"  which  controls  the  variations  in  the  recovered  gyro 
biases  (see  Section  4  of  the  Final  Report).  In  addition,  we  can  also 
offset,  by  a  constant  amount,  the  interlocks  between  the  vehicle  and 
gyro  frame  (nominally  set  to  zero). 

The  data  frames,  read  from  an  external  file,  are  processed  one  at  a 
time.  For  each  frame,  the  Euler  parameters,  and  the  associated 
covariance  matrix  from  analysis  of  the  previous  frame,  are  integrated 
forward  by  subroutine  Runge  (for  the  first  frame  we  can  use  the  true 
values  for  B^q  or  some  offset).  Subroutine  Orbit  computes  the  position 
and  velocity  of  the  earth  and  satellite  (the  total  velocity  is  used  by 
Access  to  add  aberration  effects  to  the  star  direction  cosines).  We 
then  call  Proc-b  to  1)  match  measured  stars  with  specific  catalog  stars 
and  2)  update  the  Euler  parameters  Byji^  and  Bg^  via  least-squares  cor¬ 
rection.  These  Euler  parameters,  the  covariance  matrix  associated  with 
Bynjt  and  the  calculated  image  coordinates  for  all  matched  stars 
are  saved  by  storing  them  at  the  end  of  the  current  data  record. 
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Subroutine  Kalman  is  then  called  to  combine  the  integrated  values 

for  6,,.,  with  the  corrected  values  from  Process  B  analysis  to  yield  an 
YN 

"optimal  estimate"  of  and  the  gyro  biases,  at  the  current  time. 
These  parameters  and  the  4^4  covariance  matrix  associated  with  the 
estimate  of  are  saved  on  the  data  file  also. 
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««****«*****'»»»*»«■•*««*«***********««•***«**«****«**•*»***«**« 
*  * 

•  PRCiCRRMrCOMBINE  « 

*  * 
**««***«****'*«*«  »«’«*«  «««*»*«*****««**««*«*«**»***««*«******»«« 


80  !  T.  STRI 

90  !  This  pro; 

100  I  Eulvr  pa' 

110  !  This  pro; 

120  !  FOVCJ)  a' 

130  ! 

140  OVERLfiP 

150  FLORT  !5 

160  OPTION  BRSE 

170  DIM  Ps0<3>, 

180  DIM  T1  :4>, I 

190  DIM  Co>^8(d, 

200  DIM  Bk^i-)<4), 

210  DIM  Bba<4), 

220  SHORT  :<yma< 

230  SHORT  i:o<^<i 

240  DIM  Pk :7,7) 

250  DIM  Xk;<7>, 

260  COM  Vg;3,35 

270  RRD 

280  ! 

290  PRINT  USI 

300  ! 

310  N$""N" 

320  INPUT  "D: 

330  PRINT  USI 

340  Pb»0 

350  IF  N:»=*'Y" 

360  • 

370  N»-"N" 

380  INPUT  "D: 

390  PRINT  USI 

400  Pc-0 

410  IF  N:r»"Y" 
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gram  combines  processes  B  and  C  oT  Star  Wars.  This  wersior  uses 
'“dimeters  relating  the  "V"  frame  to  the  inertial  frame, 
gram  also  recovers  the  Euler  parameters  relating  F0V<fl>  tc 
'id  tke  gyro  bias  estimates. 


■s0<3),Ps<3), Vs<3),Pe0<3),Ve0<3>,Pe<3>, Ve(3> 
;<3,3) 

!) 

!untrue<4) ,Bvg<4>,Buns<4) 
i:batrue<4),Voc<3),Bbae<4>,Bbalsq(4> 
l0,2),Xymb<10,3),Xyca<5,2),Xycb<5,2>,Xyt<10,3> 
,  4>,Ul<61),U2<61>,U3<61>,Short 
,La(i  <7,7) 

•:ki  <7),Xkb<7),Q<3,3),Qba<4,4>,Pba<4,4> 

,  INTEGER  Table<529,2> 


IMG  "K";  "«<!#####««*«###«######  PROCESS 


oing  Proc  B  <Y/'N)?",N» 

IMG  'VK,R";  "Doing  Proc  B  (Yz-N)?  " ,  N* 

"  THEN  Pb-1 


oing  Proc  C  <Y/'N)?",N$ 

IMG  “z'K,R";  "Doing  Proc  C  <Y/N>?  ",N* 

"  THEN  Pc»l 


R  M  D  C 


IF  Pb>0  THEN  Hauc_table 
!  ~ 

PRINT  USING  "K";"Insert  star  catalog  disk  into  F8,l....Then  press  CONT" 
PRUSli 

N$>”  "  !  Set  answer  to  blank. 

INPUT  "Hai-  tke  table  of  star  cell  positions  been  read-in?", N$ 

PRINT  USING  "/'K,K";"Has  cell  table  been  read-in?  ",N» 

IF  N»<>"'«'  THEN  Have  table 
!  “ 

RSSIGN  il  TO  "Tab22:F8,l" 

RERO  *1,1 


540  RERD  #l;r«ib1c<*>  !  Read  in  table  of  cell  positions. 

550  RSSDjN  *  TO  «1  I  Close  this  file. 

560  ( 

570  RSSICN  »2  TO  ‘'Hss220:  F8,  1 "  !  Star  catalog  file. 

580  • 

590  Haoe_table:  !  Ccme  here  if  this  is  a  continuation. 

€00  INPUT  “I'^put  file  name  and  device  with  simulation  data  (Si  mnnn:  F8, 0> :  “  >  D 

1  n$ 

€10  PRINT  USING  "/K, K" Input  file  name  and  device  with  simulation  data:  ",D 

i  n$ 

€20  RSSIGN  ttl  TO  Din* 

630  !  BUFFER  Ml 

€40  CHECK  RETD  Ml 

€50  ! 

€60  READ  Ml , 1 ; Rs, Us, PsO< *> , Vs0( »> , Re, Ue, Pe0< *> , Ve0<»> , Inc  1 , S i gxy, S i gm, Si gb, S 

i ggy , De 1 1 , T i me , S t  (  p 

670  PRINT  USING  "-^K,  DDDDD" ;  "Satel  1  i  te  orbit  major  axis  <km>:  "  ,  fls 

€80  PRINT  USING  "K, D. DDDDE" ; “Earth  orbit  major  axis  <km>:  ",Re 

690  PRINT  USING  "K, DDDDD" ; "Satell i te  orbit  inclination  (deg. > : " , Inc  1 

700  Si gxy«Mfl><< Si cxy,  lE-3) 

710  PRINT  USING  "K, DD. DO" ; "Rate  gyro  data  spacing  (sec>:  ",De1t 

720  PRINT  USING  “K,  DD, DD" ; "Runge-Kutta  time  step  (sec):  ",Step 

730  PRINT  USING  "K,  0.  DDOE" ;  “Gyro  standard  deviation  (rad/sec):  ",SiggS' 

740  ! 

750  Si  ggv«MR><(  S i  cgy ,  2. 424E-6)  !  Must  keep  gyro  std.  dev.  non-rero. 

760  ! 

770  Ds0*:)OT(’j.0,Vs0) 

780  Rs0=SQR(  OOKF  s0 ,  Ps0> )  !  Constants  for  orbit  calculation. 

790  De0«:)OT( 0,'»e0) 

800  Re0»SQR(OCiT(Fe0,Pe0>) 

810  T0*0  !  Set  reference  time. 

820  ! 

830  REDIh  Ul(33) 

840  RERD  Mi;41(*)  I  Read  all  the  perturbation  constants. 

850  ! 

860  FOR  I»=l  10  4 

870  Bbariom(  I  >=M1  ( I )  !  Retrieve  the  nominal  interlock  values 

880  NEXT  1  !  from  this  list. 

890  ! 

900  REDIM  Hl(€l) 

910  ! 

920  IF  Pb=0  THEN  RERD  Mi;Uba  !  Read  the  weight  for  interlock  recovery. 

930  IF  Pb=0  THEN  Ski  pi 

940  ! 

950  INPUT  " I nput  weight  in  arcseconds  for  interlock  variance  (2, 5, et c . > " , Wba 

960  PRINT  USING  'VK,  DD.  DDD" Input  weight  in  arcseconds  for  inte^'lcck  vanan 

ce  (2, 5, etc . )  ", 4ba 

970  PRINT  Ml;Mba 

980  MRT  PbaoIDN  !  Set  up  interlock  Kalman  filter  matrices. 

990  MRT  Pba**ba»( lE-6)  !  Set  covariance  matrix  to  large  initial  value. 

1008  ! 

1810  MRT  Qba-IUN 

1028  Qba(l,l>>l/'8 

1038  Qba( t,2>>- l^S  I 

1040  Qba(2, 1 )  **'1/S  !  Qba  is  the  process  noise  matrix  for  the 
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1050  QbA<.^,  2>  ■]  <^8  I  inttrlock  Angles  between  F0VC8>  and  F0V<B>. 

1060  QbaC), 3> *1 ^4  I  The  Q  matrix  has  been  concerted  to  Euler 

1070  Qba<4, 4 ) »1 ^4  !  parameters.  NOTE:  This  matrix  is  valid  for 

1080  HAT  0ba-3ba*((Uba*4.848E-6>^2>  !  (3,1,3>  rotation  of  <0,90,0>  only  I 

1090  tIAT  Pbaa^ba  !  Can  start  with  good  estimate. 

1100  ! 

1110  Sk i pi :  1 

1120  M«1EI  !  SQF<Meight)  for  constraint  equation. 

1130  • 

1140  IF  P<:^0  THEN  Skip2 

1150  • 

1160  INPUT  "  I -(put  Gyro  B  i  as  Standard  Deviation  ( Degrees^Hr ) " ,  S  i  gb  i  as 

1170  PRINT  USING  "/K, DD. DD" Input  Gyro  Bi as  Standard  Deviation  <Degrees/Hr 

>  "(Sigbias 

1180  PRINT  ttl;Sigtias 

1190  Si gb i as* 3i gb i as*PI/< 180*36O0>  !  Convert  to  rad i ans/sec . 

1200  ! 

1210  NAT  Lam*ZER 

1220  FOR  1*5  ret  7 

1230  Lam( I , I : *Si gbi as^2  I  Set  observation  covariance  matrix  for  gyre  bias. 

1240  NEXT  1 

1250  ! 

1260  MAT  Pk*I0N 

1270  MAT  Pk=P<t<lE-7)  !  Set  covariance  to  large  value. 

1280  ! 

1290  Qfac=Sig3y^2 

1300  MAT  Q*ID'i 

1310  MAT  tJ*Q*<C!fac)  !  Initialize  process  noise  matrix. 

1320  PRINT  USING  Form3; "Q  Mat r i x: " , Q<« > 

1330  ! 

1340  MAT  ;3vg*JE:R 

1350  Bvg<l)*l 

1360  N$»"N" 

1370  INPUT  "Da  you  want  to  offset  matrix  VG  <V-frame  to  Gyro  frame)  ",1)1 
1380  PRINT  USING  'VK,K";"Do  you  want  to  offset  matrix  VG  <V-frame  to  G|.  ro  fra 
me)  "iNf 
1390  ! 

1400  IF  N:»*"N"  THEN  GOTO  Sk  i  pvg 

1410  Bvg<l>»l 

1420  Bwg<2)»lE-3  !  Size  of  offset  can  be  changed. 

1430  Bv.j<3) 2E-3 

1440  Bv.}<4)*::E-: 

1450  Ma>j*S0?<  DOT  <Bvg,  Bvg)  )  ‘  Re-normal  ize  Euler  parameters. 

1460  MAT  Bw3*Bv5/<Mag) 

1470  Skipvg:  ! 

1480  CALL  D!r:c.sb<Bwg<*),Vg<*),0,T2<*),T2(*),T2(»),T2<*)) 

1490  PRINT  USING  Form3; "Matr i x  VG  for  this  run;",Vg<*> 

1500  • 

1510  Skip2:  ! 

1520  ! 

1530  C*3E:5  !  Speed  of  light  <km/sec). 

1540  Pa*s*0  1  First  pass  through  frame  loop  -  special  case. 

1550  Tk*Time  !  Initial  time. 

1560  MAT  :<ki*2ER 

1570  MAT  :<kt*2E.R 
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1580  ! 

1590  !  ♦  +  H+  +  4+  +  +  B*gi>i  Loop  0o*r  O&ta  Frames.  ♦  +  4-  +  +  +  +  +  +  -*-  +  +  + 

1600  ! 

1610  FOR  Ifile=2  TO  30  !  Loop  over  all  data  frames. 

1620  PRINT  USING  "/K,  DDD,  K“ ;  RECORD  NUMBER;  ",lfile,  ••  fv  ^  ^  ^  ** 

1630  Pass=Pas»+l 

1640  ! 

1650  RERD  #1,  Ifi 1e 

1660  RERD  «1 ; Bvntrue<*) 

1670  PRINT  USING  Forml ; "Bvn. . . . True  Euler  parameters  between  V  and  N  frames:" 
, Bvntrue<»> 

1680  REDII1  Xl<t(4) 

1690  MRT  ;<k  t  =  Bk'nt  r  ue 

1700  REDIM  Xkl<7) 

1710  IF  Piss=l  THEN  MRT  Xki=Xkt  !  This  causes  displacement  of  first  estimate. 

1720  ! 

1730  RERD  #l;B'.'n<t«>  !  These  are  not  used  unless  we  do  Proc.  B  onl!,j. 

1740  !  PRINT  USING  F orm 1 Bvn .... Est i mated  Euler  parameters  between  V  anc  N  fra 
mes: " , Bvn<*) 

1750  ! 

1760  RERD  #l;B'.'g<'<)  !  True  Euler  parameters  between  V  and  G  frames. 

1770  !  CRI.L  Dircosb<Bvg<*),  Vg<*>,0,T2<*>,T2(*>,T2(:*>,T2(*>)  !  Could  use  truth 


1780  RERD  #l;B<.'g<t()  I  same  comment  as  Bvn.... not  used. 

1790  ! 

1800  READ  #1 ;  Bt>atrue<*)  !  True  Euler  parameters  between  B  and  R  frarne. 

1810  RERD  #1 ; 6batrue<*)  !  same.... not  used. 

1820  IF  P.iss»l  THEN  MRT  Bba=Bbatrue  !  Can  help  out  by  setting  est ima» e=truth. 

1830  ! 

1840  PRINT  USING  Forml ; "Bba. ...  True  Euler  parameters  between  B  and  R  frames:" 
, Bbatrue<e) 

1850  PRINT  USING  F orm 1 Bba. ...  Current  Euler  parameters  between  B  and  F  frame 
s: " , Bba<») 

1860  ! 

1870  RERD  #l;  i/c.c(«) 

1880  PRINT  USING  Form3;  "Components  of  total  velocity  ( k  m/sec  ) :  "  ;  Voc  ( » 

1890  MRT  7oc  =  v'c.c/<C> 

1900  ! 

1910  REDIM  XyTia<lEl,3),Xymb<lEl,3) 

1920  PRINT  USING  "K"; "Number  of  stars  in  each  FOV:  " 

1930  ! 

1940  RERD  #l;'ifovfta 

1950  PRINT  USING  "K,X,DD";"  FOV<R> ; " , Nf ovma 
1960  RERD  #l;><yma<*)  !  True  coordinates. 

1970  RERD  #l;’<vma<*)  !  Measured  coordinates. 

1980  ! 

1990  RERD  «1 ;  Tfovitb 

2000  PRINT  USING  "K,X,DD";"  FOV<B) : " , Nf ovmb 
2010  RERD  «l;’(ymb<*)  !  True. 

2020  RERD  KliKymb^e)  !  Measured. 

2030  I 

2040  RERD  # 1 ; 4 1 < * > , W2< * ) , W3< •  )  I  Read  rate  gyro  data  for  eacn  axis. 

2050  ! 

2060  REDIM  Xkt(7> 

2070  RERD  #1 ;  ■{k  t  <5  > ,  Xkt  (6> ,  Xkt  <7>  !  Read  true  bias  rates. 


2080  ! 

2090  IF  P.;=0  THEN  Sk  i  p3 

2100  CHLL  Runjf  (Tk,D*lt,Step,Ml<*),U2<*>,M3<»>,Xkl  ( *> ,  Pk  <  *  > ,  Q<  •  > ,  S  i  gb  1  «.s  > 

2110  I 

2120  PRINT  USING  Form2;  "Bv^n.  ...  Integrated  Euler  perimeters  between  V  ard  N  fr 
ames'',''and  g;<ro  si  ases:  "  •  Xk  1 
2130  ! 

2140  RE0II1  Xki<4> 

2150  MAT  :3un=><k  i  !  Estimates  for  Process  B. 

2160  !  IF  Pas»=-1  THEN  MAT  Bwn*Buntrue  !  Can  help  out  by  setting  est. “truth. 

2170  REDIM  Xki<7) 

2180  ! 

2190  Skip3:II-  Pc={i  Ti-EN  Tk=Tk+Delt 

2200  CALL  Orbit <Tk,Ps<*>, Vs<»),Ps0<*>,Vs0(*>,T0,Us,As,Ds0,Rs0) 

2210  CALL  Orbit <Tk,Pe<*),Ve<*),Pe0<*),Ve0<*>,T0,Ue,Ae,De0,Re0> 

2220  MAT  Voc  =  v'j+Vs  !  Total  velocity. 

2230  PRINT  USING  Form3;  "Components  of  total  velocity  (km^'sec  ) :  ”  ;  Voc  <*) 

2240  MAT  Voc“Voc.'<C) 

2250  ! 

2260  IF  Ph“0  THEN  Sk i p4 

2270  I 

2280  MAT  .3bae=I:ba  !  Save  the  estimated  interlock  vector. 

2290  CALL  Pro:_b<<l2,Bvn<*),Bba<*),Voc<*),  Nfovma,  Nf  ovmb,  Ka,  Kb ,  W,  S  i  gxy ,  ma<  *  )  , 
Xymb<*),Xyca;*),-<ycb<*>,Cov8<*),Pba<*>,Qba<»>,Bbalsq<*>> 

2300  !  OUTPUT  ft  USING  Form9; If i 1 e, Nfovma, Nfovmb, Ka, Kb  !  Progess  indicator. 

2310  Form9;  IMA:e:  5<DD,XX) 

2320  ! 

2330  FOR  1=1  TO  4 

2340  FOR  70  4 

2350  Co.><  I ,  J  >«Cov8<  I ,  J) 

2360  NEXT  .• 

2370  NEXT  I 

2380  PRINT  #  1 ;  livn  ( e ) ,  Bba(  *  >  !  Save  Process  B  results. 

2390  PRINT  «l;C:ov<*) 

2400  PRINT  «l;Ka,>-yca<.*) 

2410  PRINT  #l;Kb,>«ycb<e) 

2420  * 

2430  Skip4:  IF  P:==0  THEN  Endloop 
2440  ! 

2450  IF  Plj=0  THEN  READ  #  1 ;  Bvn< * >  ,  Bba( *)  ,  Cov< * )  ,  Ka,  Xyc  a< *  >  ,  Kb ,  Xyc b<  * > 

2460  IF  <Ka=0)  AN!  <Kb=0)  THEN  Proc_b_f ai 1 ure 
2470  REDIM  Xks<4> 

2480  MAT  Xkb=Bvn 

2490  REDIM  Xks<7) 

2500  ! 

2510  FOR  [=1  TO  4 

2520  FOR  J=1  TO  4 

2530  L  im<  I ,  .'')*Cov<  I ,  J)  !  Fill  obs.  cov.  matrix  with  Proc  .  B  results. 

2540  NEXT  J 

2550  NEXT  I 

2560  ! 

2570  REDIM  Xki <4) 

2580  MAT  ri«X<i 

2590  REDIM  Xki<7) 

2600  ! 
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r 


I 

I 


CALL  Ka»  k  t  < *  >  ,  Xk  i  < » )  ,  Pk  < * >  ,  Xkb< *  >  ,  LamC * >  > 

I 

!  Com#  her#  if  Proc  B  failed  to  find  stars 


Proc_b_'ai  1  jr  #: 

! 

PRINT  iH;>:ki<*) 
PRINT 

! 

FOR  [=1  TO  4 
FOR  J=1  TO  4 
:;hori*iPk  <  I ,  J) 
PRINT  il; Short 
NEXT  J 
NEXT  I 

PRINT  #I;l!baJsq<») 


2610 
2620 
2630 
2640 
2650 
2660 
2670 
2680 
2690 
2700 
2710 
2720 
2730 
2740 
2750  ! 

2760  Endloop;  ! 
2770  PRINT  ’• 
2780  ! 

2790  NEXT  I  Ml# 
2800  ! 

2810  Stop: 

2820 

2830 

2840 

2850 

2860 

2870  ! 

2880  Formi:  imfi:e; 
2890  For  m2;  IMft^E. 
2900  Form3;  .  IMfi:E: 
2910  I 

2920  END 


in  both  FOV. 


Sao#  Proc.  C  results. 


(end  of  frame)" 


PRINT 
PRINT  •• 
FOR  1=1 
BEEP 
WRIT 
PEXT  I 


THE  END 


TO  5 
120 


/k,/,4(MD.DDDDDD,XX) 

/k  ,/,K,/',4<MD.DDDDDD,X>,/,3<MD.DDDE,X) 
/K,3</3<MD.DDDE,XX>> 


4 
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Access 

Access  determines  which  catalog  cells  the  camera  boresight  lies  in 
or  near  and  then  retrieves  the  star  positions  for  the  stars  contained 
in  those  cells.  The  first  step  is  to  determine  the  polar  angle  and 
longitude  angle  of  the  boresight  unit  vector.  These  angles  are  converted 
to  primary  cell  indices  by  dividing  by  the  cell  size.  In  a  similar 
manner,  we  also  determine  three  nearest  neighbor  cells.  The  location  of 
each  cell  in  memory  or  on  a  storage  device  and  the  number  of  stars  in 
each  cell  are  found  by  referring  to  a  table.  We  then  read  the  star  data 
from  these  cells  (consisting  of  direction  cosines  and  magnitude)  and 
compute  the  vector  dot  product  of  each  star  with  the  boresight  unit 
vector.  If  the  product  is  less  than  some  specified  tolerance  we  reject 
the  star;  this  product  is  also  used  to  sort  the  subcatalog  by  distance 
off  the  boresight.  A  list  of  up  to  100  stars  is  returned  to  the  calling 
program. 


See  Appendix  3  for  details  on  the  catalog  format. 


*««********»'»*«*»«•«« *****«*•**«*#**»«*«•**•***«*«*•*«******«« 

»  * 

*  fiCCESS  ♦ 

*  * 

*«****«***»« »*****«*«***«******»»*«***««***««**»**««* 

6260  \  Access  g»ts  stars  from  the  catalog  for  cells  surrounding  the  boresight. 

6270  SUB  Access  <  ,  h  fow,  Bore<  »>,  Si  gma,  Radi  us,  Voc  (♦>,  SHORT  Fou<*)> 

6280  OPTION  BASE  1 
6290  DIM  Ang<103: ,Cc<3) 

6300  INTEGER  K<4; ,J<4),Nt,Kk,M,N 
6310  SHORT  Mag, Hum 

6320  COM  Vg:3, 3), INTEGER  Table<529,2> 

6330  REOIM  l-ou(l(i0,4> 

6340  ! 

6350  DISP  "Access" 

6360  I 

6370  Nt=22  !  Nurrber  of  latitude  bands  for  this  catalog. 

6380  Dphi  =2  *PI ''(^♦Nt  +  1 )  !  Latitude  spacing. 

6390  ! 

6400  Nfou^O 

6410  Ct  est  =i;0S  <  ?iid  i  I.  s  +  S  i  gma>  !  Maximum  angle  off  the  boresight. 

6420  Phi  =ACS<Bo'^€  (3) )  !  Polar  angle. 

6430  IF  Phi  ;0  THE:N  Fhi=Phi  «-2*PI 

6440  ! 

6450  Lam=PI'2  !  Calculate  longitude  angle. 

6460  IF  Eor<?(2)(0  TFEN  Lam  =  Lam  +  PI 

6470  IF  Bored  )(:0  THEN  LamaATN<Bore<2)/'Bore<  1  > ) 

6480  IF  Bored  )<(i  TFEN  Lam=Lam  +  PI 
6490  IF  Lam:0  THEIN  Lam*Lam+2*PI 
6500  ! 

6510  PRINT  iJSINj  "  / ,  K ,  X ,  DDD .  D,  X ,  K"  ;  "Pol  ar  angl  et  ",  Phi  eieOxPI ,  "Degrees" 

6520  PRINT  USIN;  "K, X, DDD. D, X, K" ; "Longi tude  ang 1 e t ",  Lam* 1 80/P I ," Degrees " 

6530  ! 

6540  !  Calculate  cell  indices. 

6550  IF  Phi  JDphi  THEN  North  1  Near  north  pole — special  case. 

6560  IF  Phi  >2*PI-Dpl- i  *.  5  THEN  South  !  Near  south  pole  —  special  case. 

6570  ! 

6580  K<  1  >=2HNT<F'hi  -  Dphi +  .  5)  !  Calculate  two  neighboring 

6590  K<3)-2 tINT<Phi  Dphi >  1  latitude  bands. 

6600  IF  K<3)»K<i:  ThEN  K<3>*K<3>+2 

6610  IF  K<l)>Nt  THEh  K< 1 )  =  2*Nt  +  l-Kd )  1  Make  sure  we're  on  the  correct 

6620  IF  K<3)>Nt  THEh  K < 3 )=2*Ht + 1 -K<3)  !  side  of  equator. 

6630  K(2)=Kd) 

6640  K<4>>K:3> 

6650  ! 

6660  D1  am=2tPI-^<2*K(  1  )  +  l  >  1  Now  determine  two  neighboring  cells 

6670  J<  1  )*  I  NT  <L  anix  D I  am+ .  5>  !  in  each  latitude  band. 

6680  J<2)»IHT<Lam/Dl am) 

6690  IF  J<2>  =  Jd;  THEN  J<2)»<  J<  1  )-t-l  )  MOD  (2*Kd>t-l) 

6700  Jd)»Jd)  ICiD  <2*Kd>  +  l) 

6710  Dlam«2tPIx<2*K<3)*l ) 

6720  J<3>*INT<Lam/Dlam+.5) 

6730  J<4)»INT<Lam/Dlam) 

6740  IF  J<4)*J<3:  TFEN  J<4>»< J<3)*1 )  MOD  <2*K<3>'*'1) 
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6750  J<3)«J:3> 

6760  GOTO  Ri'our 
6770 

6780  North: 

6790  K<1)«0 


lOD  <2*K<3>+1> 
i 


6790  K<1)«0 

6800  K<2>«2 

6810  K<3>-2 

6820  K<4>-2 

6830  J<1>>0 

6840  J<3>>>INT<L 

6850  J«:2)  =  J:3>  + 

6860  J<4>>j:3>-t 

6870  GOTO  Ri'oun 
6880  ! 
6890  South:  ! 
6900  K<1)=1 

6910  K<2)=1 

6920  K<3)=1 

6930  K<4)*3 

6940  J<1)=0 

6950  J<2)*1 

6960  J<3)=2 

6970  J<4)=1HT<L 

6980  ! 

6990  Rround:  !  S 
7000  PRINT  USIN 
7010  ! 

7020  FOR  I=l  TO 
7030  M=K<r>»K 

7040  N=Tal)le< 

7050  RERO  *1, 

7060  Kk=T.»bU 

7070  FOR  I<=1 

7080  RERD  « 

7090  fla;jOT< 

7100  IF  fi<C 

7110  Nfou=N 

7120  Rn.3<Nf 

7130  ! 

7140  Scile* 

7150  MAT  Co 

7160  MAT  Co 


Special  case  for  north  pole. 


!  Get  indices  for  polar  cap  and 
I  three  of  the  fiue  cells  in  next  band. 


am/<2*PI/'5>  +  .  5> 
4  MOr  5 
1  MOI  5 
d 


Special  case  for  south  pole. 

!  Get  all  three  cells  at  south  pole  and 
!  one  of  the  seuen  in  the  next  band. 


aiii'^<2*Pl'^7)  +  .5) 

<ip  rorth  and  south  pole  stuff. 

2  'V,K,/',2<4<DDD,X)/)“;"Cel  1  i  ndi  ces:  "  ,  K<  *) ,  J  (*) 


<1  )+J<I>  +  l 

1,1) 

1 

<M,2> 

rci  Kk 

1 ;  Co<*) , Nag, Num 

;c<,Bcre)  !  Compute  cos  of  interstar  angle. 

t«st  THEN  Continue 

f«M+l  !  Star  lies  within  range  of  bores ight, 

3U)*F 


l-D0T<Voc,Co) 

»C:oe<Scale) 

«Co+Voc 


!  Add  aberration  effects. 


7180  FOR 

7190  l■ow< 

7200  NEXT  J 

7210  FouCNf 

7220  Continue:  N 
7230  Skip:  ! 

7240  NEXT  I 
7250  ! 

7260  IF  Nfou<>0 
boresi ght . 

7270  ! 

7280  DISP 
7290  SUBEND 


1  TO  3 

If ow, J) =Co< J)  !  Saue  this  star. 

ju, 4) -Mag 
•XT  k 


THEk  CALL  Sort <Ang<*) , Fow<*> , Nf ow, 4)  !  Sort  stars  by  ancle  off 
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Bias 

Subroutine  Bias  computes  bias  terms  which  are  later  added  to  the 
rate  gyro  data.  We  have  used  a  simple  sinusoidal  variation  added  to 
each  nominal  bias  value.  For  input  we  specify  the  time,  orbital 
frequency,  nominal  bias  values,  and  amplitude  and  frequency  of  each 
variation. 
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»  B  1  R  S  « 
«  * 
«•»«*«*««**«>***»«'**««**»***«*«**«««****«»«««»«**•*««*«******« 


7650  SUB  Bi ts<Dl , SHCRT  Bi asnom<«> , Ebi > , Nbi as ( « > , RERL  Omega, 6i as<*> > 
7660  !  This  sub'-c>utine  computes  the  bias  rates  to  be  added  to  gyro  rates. 

7670  OPTION  BRSE  1 
7680  • 

7690  Bi  as(  1  t^Bi  a:  noir  <l)'fEbias<l  >«C0S<Nbi  as<  1  >*OfflegaeDt  > 

7700  Bi  as<2  >s6i  as  non  <2>-*'Ebias<2)*SIN(Hbias<2>s0megaeDt> 

7710  Bi  as<3  >3Bi  as-noe  <3>-*-Ebi  as<3>*SIN<Nbi  as<3>*Umega«Dt  > 

7720  ! 

7730  SUBEND 
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Cross 

Subroutine  Cross  computes  the  vector  cross-product  of  two  vectors. 


! 


I 


J 


124 


***•*•««*«•*■««**»«'**««»«*»«**«***«««««*»«**««•**«**«««**«****» 

«  » 

#  CROSS  * 

*  « 
******«***«*■»««*»«■**«««**«***«*«**«««******«***«««***«**«***«« 

6290  !  This  suborogr«m  computes  the  cross  product  of  two  vectors. 

6300  ! 

6310  SUB  Cross<?<*>,Vl<*>,V2<*)) 

6320  OPTION  BRS£  1 
6330  I 

6340  FOR  K>1  TO  3 

6350  K1>K  HOD  3-*-l  !  Determine  the  order  of  multiplication. 

6360  K2*Kl  HOD  3>1 

6370  R<K)«V1<<1  )*'»2<K2)-V1<K2)*V2<K1) 

6380  NEXT  K 
6390  ! 

6400  SUBEND 
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Deriv 

This  subroutine  forms  the  right-hand-side  of  the  matrix  Riccati 
equation,  which  is  integrated  by  subroutine  Runge  to  propagate  the 
covariance  matrix.  We  use  the  partitioned  form  of  the  Riccati  equation 
as  presented  in  Appendix  8  of  the  Final  Report. 

The  input  data  consist  of  the  upper  4x4  portion,  lower  left 
3x4  portion  and  lower  right  3x3  portion  of  the  covariance  matrix. 

In  addition,  the  subroutine  requires  the  3x3  process  noise  matrix 
and  two  portions  of  the  matrices  used  for  the  state  differential  equa¬ 
tions  (see  Appendix  8).  The  output  is  the  time  derivative  of  the  upper 
4x4  and  lower  left  3x4  portions  of  the  covariance  matrix  evaluated 
for  the  current  state. 


**«******•««»•**»«■•*««*««*««««««**««««««««««•«««**##***«•««*«* 

*  * 

*  0  E  R  1  V  * 

«  * 

«****««««*»«>**«»*'*«««•«»«*««*«»***««’*««**«»**«*«**«***•**«««* 

14890  !  This  sub'^outine  sets  up  the  RHS  of  the  matrix  Riccati  equation  in 
14900  !  part  i  t  io'tc'd  form. 

14910  SUB  Deriv<»l 1 << ) , P21 <*) , P22< *) , Q< *> , fll 1 < *> , fll2(*> , Kn<» > , Ln<* > > 

14920  OPTION  BRS*  1 

14930  DIM  T1 :4,4>,T2<4,4),ftl2t<3,4) 

14940  * 

14950  MfiT  Tl*flll*Pll 
14960  MftT  T2*«12*P21 
14970  MAT  Tl=*Tl  +  r;r 
14980  MfiT  T2sTRN<Tl) 

14990  MAT  Kn»Tl  +  T;; 

15000  MAT  A12t-T?N<A12> 

15010  MAT  T1*A12*C! 

15020  MAT  T2*Tl*912t 
15030  MAT  Kn=»Kn+r;: 

15040  • 

15050  MAT  Tli»P21»All 
15060  MAT  T2=P22»A12t 
15070  MAT  Ln»T2-n 
15080  ! 

15090  SUBEND 
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Dircosb 

This  subroutine  computes  the  rotation  matrix  between  two  coordinate 
frames  as  a  function  of  the  Euler  parameters.  If  selected,  the  partial 
derivatives  of  the  rotation  matrix  with  respect  to  each  Euler  parameters, 
are  calculated  also.  Refer  to  Section  2  of  the  Final  Report  for  the 
form  of  the  rotation  matrix. 
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***»***«****'*»*«»«■«*««•««*«««**«***«»***»*»•**»«*«*«««*««*»««« 
#  # 

*  IIRCOSB  * 

*  * 
******•**«»*'»*»»»«•*•«»******««•**«««»•«««««««**««**»**«******* 


8880 
8890 
8900 
8910 
8920 
8930 
8940 
8950 
8960 
8970 
8980 
8990 
9000 
9010 
9026 
9030 
9040 
9050 
9060 
9070 
9080 
9090 
9100 
91 10 
9120 
9130 
9140 
9150 
9160 
9170 
9180 
9190 
9200 
9210 
9220 
9230 
9240 
9250 
9260 
9270 
9280 
9290 
9300 
9310 
9320 
9330 
9340 


!  Dircosb  romputes  ths  direction  cosine  matrix  using  EULER  parameters 
SUB  DircosD<B<<>,C<*),Ndc,Dcl<»>,Dc2<*>,Dc3<*>,Dc4<*>) 

OPTION  BASE  1 
! 

DISP  Mircaib" 

! 


BB-BCl > 

B1»B<2> 

B2sB<3> 

B3*B<4> 

B12»B1 »B1 
B22»B2»£2 
B32=B3tB3 
B02>B0»B0 

C<1,  1><>B02*^I:12-B22-B32 
C<1,2)==2*<B1*B2  +  B0*B3> 
C<1,3)  »2*<BJ*B:--B0»B2) 
C<2, 1) «2*<B1*B2-B0*B3) 
C<2,2)  »E02-l!l2-»B22-B32 
C<2,3) »2*<B2*B3+B0*B1> 
C<3,  l)^*2*<ei*B2+B0eB2> 
C<3,2)»2*<B;:*B2-B0*Bn 
C<3,3>  •B02-Iil2-B224632 
! 

DISP 

t 

IF  NdcOl  THEN  SUBEXIT 
! 


DISP  "JircDJb" 
! 

BO::B0>30 

Bl=Bl+:31 

B2*B2+32 

BS-BS^-.iS 

I 

DcKl,  1)>B3 
Dcl<l,2)=B3 
Dcl(l,3>»-B2 
Dcl<2, 1>*-B3 
Dcl<2, 2)383 
Dcl<2,:3)-Bl 
Dcl<3, 1>«B2 
Dcl<3,2)»-Bl 
Dcl<3,3>-B3 
! 

Dc2<l, 1>*B1 
Dc2<l,2>-B2 


Direction  cosine  matrix. 


!  Don't  need  partials. 

!  Compute  the  partials  of  C  w.r.t.  each  beta,. 
!  Do  this  for  factor  of  two. 

!  Partials  w.r.t.  Beta0. 

I  Partials  w.r.t.  Betal. 
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9350  Dc2<l,3)=B3 

9360  Dc2(2,l>«B2 

9370  Dc2<2,2)  —  Bl 

9380  Dc2<2,3>>>B3 

9390  Dc2<3,l>»B3 

9400  Dc2<3,;2>»-B£i 

9410  Dc2<3,3)»-Bl 

9420  I 

9430  0c3<t,l>B-B2  !  P«rti4ls  u.r.t.  Beta2. 

9440  Dc3<l,:>>«Bl 

9450  Dc3<l,3)»-B0 

9460  l)c3<2,l>sBl 

9470  Dc3<2,;2)=B2 

9480  0c3<2,3>«B3 

9490  Dc3<3,l>*B3 

9500  Dc3<3,;2)»B3 

9510  Dc3<3,3>«-BJ: 

9520  ! 

9530  Dc4<l,l>*-83  !  Partials  w.r.t.  Beta3. 

9540  Dc4<l,i2)«B3 

9550  Dc4<l,3)»Bl 

9560  Dc4<2,  l)=-B£i 

9570  Dc4<2,.2)  =  -B:-! 

9580  Bc4(2,:3)sB2 

9590  Dc4(3,l)»Bl 

9600  Dc4<3,;2>>B2 

9610  0c4<3,:3>>B3 

9620  < 

9630  DISP 
9640  SUBENO 
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Dxdbeta 


This  subroutine  computes  the  partial  derivatives  of  the  calculated 
image  coordinates  with  respect  to  each  of  the  four  Euler  parameters 
orienting  the  star  tracker.  We  have  rearranged  the  partial  derivative 
calculation  into  a  simple  form.  We  want,  for  FOV(A)  for  example. 


3X. 


30 


VN. 


=  I 


3X„  3AN  -  . 
m  jj^ 


to  »''Nlo 


(m  =  1 ,2,. . .no.  of  stars 
n  =  0,1,2, 3). 


We  note  that  matrix  3AN/33yi^  =  AV  •  3VN/33yj.  where  AV  is  calculated 

'n  ”n 

by  Mat-av  and  3VN/33y|^  is  calculated  by  Dircosb  and  this  matrix  is 

n 

independent  of  the  particular  star. 

The  terms  3X|^/3AN^j  are  derivatives  of  the  stellar  colinearity 
equations  with  respect  to  the  terms  in  the  rotation  matrix.  If  we 
rotate  a  star's  direction  cosines  {L}  into  the  FOV(A)  frame,  we  have 

{L'}  =  AN  •  {L} 


Then,  the  normalized  image  coordinate  X/f  =  Ll/LJ  where  f  =  lens  focal 
length.  The  3  x  3  matrix  3Xy3AN  becomes 

Li  L?.  La 

0  0  0 

Likl  UU  kkL 

or  simply  the  outer  product: 
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To  obtain  the  derivative  we  can  proceed  to  multiply  each  term  in  this 

3x3  matrix  by  the  corresponding  term  in  9AN/86y|^  and  then  sum  all 

n 

terms.  However,  it  is  not  too  difficult  to  see  that  this  can  be 
accomplished  by  writing 


ax. 


m 


ae 


VN, 


r3AN  1 

j 


-96 


VN_ 


a  form  very  suitable  for  computation.  The  partial  derivatives  of  the  y 
coordinate  are  similar. 
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«*««******•«'»*«*»*■«*«**«*»*»*«««««***•«««**«**««**«*««««**«««« 

«  * 

«  IXDBETA  * 

*  * 

««««««*«««**■»*«*»*■**«***»**»*»»*»*•*««*«*»«»«»**«*»*»*«*««*«*« 

8350  I  Dxdb'?t«  :c>mpttes  partial  derius  of  <x,v>  w.r.t.  Euler  parameters. 
8360  !  d<x  or  y>/d<Eeta<  i  >  >>SumC  <d<x  or  y )>'d<Ci  j  >  > .  <d<Ci  j  >^d<Bet a<  i  >  >  3 

8370  I  where  represents  mult,  corresponding  terms. 

8380  I  We  have  “'larranged  this  sum  into  compact  form  used  here — (see 
8390  I  note:»  of  T.  S  t r  i  kuerda)  . 

8400  SUB  Dxdbet  a<Ftc(*>,8(*),Kk,C(«>,Dcl<«>tDc2(«>,Dc3Ce),Dc4(«>> 

8410  OPTION  BRSE  1 

8420  Dili  T1  :3> ,  r3<3> ,  T4<3> , L<3)  I  Dimension  temporary  matrices. 

8430  < 

8440  DISP  ".Jxdbeta" 

8450  ! 

8460  FOR  K=l  TO  Kk  !  Loop  ouer  all  stars  in  this  FOV. 

8470  K1=K>K-1 

8480  K2sKl>l 

8490  FOR  l~l  rO  3  I  Get  direction  cosines  for  this  star. 

8500  L<  (>-Flcl(K,  I) 

8510  NEXT  I 

8520  MPT  ri«C»l.  I  Compute  direction  cosines  in  FOV  frame. 

8530  T3<1  )*l>'n<3) 

8540  T3<2)«>0 

8550  T3<3>  —  T1<  1)«T3<1)»T3<1) 

8560  T4<1»»0 

8570  T4<2>»T3<n 

8580  T4<3)»-Tl<2)aT3<l)*T3<l) 

8590  ! 

8600  MfiT  ri=D:l*L 

8610  fl<Kl  .  1  )*0CiT<T  1 ,  T3)  i  d<x)/d<BetaO> 

8620  fi(K2 . 1  )  =  0CiT(l  1 ,  T4)  !  d<y >>'d< Bet  a0 ) 

8630  • 

8640  MPT  ri*D:;-*L 

8650  P<k:i  ,  2)  =  OOT<7  I ,  T3)  •  d<x>/d<Betal  > 

8660  P<k:2.2)»0(iT<71,T4)  !  etc. 

8670  ! 

8680  MPT  ri»D::!*L 

8690  PCKl  ,3)»0(iT<71,T3) 

8700  P<K2,3)*0CiT<ll,T4) 

8710  ' 

8720  MPT  riaD:'*L 

8730  P<K1 .4)  =  DCiT(71,T3) 

8740  P<K2,4)»0(iT<TI,T4) 

8750  ! 

8760  NEXT  K 
8770  ! 

8780  DISP 
8790  SUBEND 
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Fin-y 

The  primary  purpose  of  this  subroutine  is  to  calculate  the  column 
vector  of  differences  between  the  calculated  and  measured  star  coordinates. 
As  input  we  pass  the  coordinate  frame  rotation  matrix,  and  an  array 
containing  the  direction  cosines  and  measured  coordinates  for  up  to  five 
paired  stars. 

Subroutine  Phoeqn  is  called  for  each  star  to  compute  the  image 
coordinates.  These  are  subtracted  from  the  measured  values  to  fill  the 
deviation  vector. 


***««««**«««•»**«»«•«««*«»*««««««««««««•*«*««««««*»»*»«•****»«** 

*  « 

#  F  1  L  L  -  Y  ft 

ft  ft 

•  ftftftftftftftftftftfttftftftfti'ftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftftft 

7260  I  Fill-y*  fills  D»1y(ft>  ulth  dftwiftition  between  Measured  eind  celc. 

7270  I  ster  positions. 

7280  SUB  Fi n  y <n d<*> , Kk , C(*> , Dc 1 y < «> , Isum> 

7290  OPTION  BftSE  I 

7300  DIM  Xx:2>, :osires<3> 

7310  ! 

7320  DISP 
7330  ! 

7340  Idi  ft2 

7350  REDIM  ;)e1y(]div> 

7360  IF  Kk-8  THEN  SLBEXIT 
7370  I 

7380  FOR  K-l  TO  Kk 
7390  FOR  (-1  TO  3 

7400  Co:t  i  ne»<  O^FI  d<K,  I  >  I  Get  direction  cosines  for  this  st*r. 

7410  NEXT  I 

7420  CRLL  Pho»c|n<Cosi nes<ft > •  C< « > , Xx<  1  > , Xx<2> >  I  CoMpute  (x,y>. 

7430  FOR  I»1  TO  2 

7440  Isumel  tum-fl 

7450  De I y< I ium>»F1 d<K,  3+1 >-Xx< I )  !  Compute  deviations  t rom  measured  <x,y). 

7460  NEXT  I 

7470  NEXT  K 
7480  ! 

7490  REDIM  .)e1y<lsu»> 

7500  ! 

7510  DISP 
7520  SUBEND 


1 

I 

I 


Gauss 


Gauss  generates  and  adds  pseudo-Gaussion  noise  to  a  variable.  The 
method  is  to  add  together  12  random  numbers  between  0  and  1  and  subtract 
6.  This  yields  a  number  from  a  pseudo-Gaussion  distribution  with  a  mean 
of  0  and  a  standard  deviation  of  one.  Obviously,  this  distribution  will 
be  truncated  at  ±6  sigma.  This  number  is  then  scaled  by  the  standard 
deviation  and  added  to  the  mean  value  (both  required  as  input)  and  the 
result  returned  to  the  calling  program. 
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««***»»««**tt'**«*»4-»*«  ««»*««*«*«*««*••«*«««*•••»***«******«**«« 


* 

» 

* 


GAUSS 


« 

* 

* 


6480  !  This  SJhrottin*  Adds  CAUssiAn  nois*  to  a  oAriAbI*. 

6490  ! 

6500  SUB  CAuss<3ig,r»An,VAr> 

6510  < 

6520  R«e 
6530  I 

6540  FOR  I- I  TO  )2 
6550  R-R^RNO 
6560  NEXT  I 
6570  • 

6580  VAr>Si  •]*<R-6>-t’l'eAn  !  Sc  Ale  the  noise  by  sigmA  And  add  to  mean. 

6590  < 

6600  SUBEhO 
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Kalman 

Kalman  performs  the  Kalman  filter  calculations  outlined  in  Section 
4  of  the  Final  Report.  The  integrated  and  calculated  states  and 
corresponding  covariance  matrices  are  passed  to  Kalman.  Currently, 
we  also  provide  the  true  state  for  comparison.  The  integrated  state  is 
replaced  by  the  optimal  state  on  return  and  the  integrated  covariance 
matrix  is  replaced  by  the  updated  matrix. 


*»******••**■**««»*■«»««««»*««*»««»**««*»****«««««•*•«««**«***«* 

*  * 

*  KRLMRN  • 

*  • 

12100  !  KAlrntn  camputcs  th*  opt<m«l  «si1in«te  *t  each  time. 

12110  I 

12120  I  T.  S-;r1k4(rd4 . 28  liai;  1981. 

12130  • 

12140  SUB  Kalman(>;kt<*>,Xki  («>,Pk<*>,Xkb(«>,Lam<*>> 

12150  OPTION  BRS£  1 
12160  DIM  Xk  :?>,  :t.rr<7) 

12170  DIM  SI :7,7>,S2<7,7) 

12180  DIM  Kal<7, 7: ,Dcv<7> 

12190  ! 

12200  DISP  "Kalman" 

12210  Ul-16 
12220  U2-0 
12230  ! 

12240  PRINT  iJSIN:  "xk " ;  "  Kalman  Filter  State  Estimation" 

12250  ! 

12260  MRT  Sl=*TRN<Pk>  ! 

12270  MAT  Pk!»Sl  +  *li  !  Ensure  symmetric  Pk . 

12280  MAT  Pk=»<.5><Pk  I 

12290  ! 

12300  FOR  I  ••I  TO  7 

12310  Xkb<t>aXti<n  I  Fill  measurement  uector  with  bias  values. 

12320  NEXT  1 
12330  ! 

12340  MAT  Sl^LamtPk  !  Add  obs.  cou.  matrix  to  integrated  cou.  matrix. 
12350  ! 

12360  MRT  S2»TRN<J:l)  ! 

12378  MRT  S1‘*S1  +  5J:  !  Ensure  symmetric  matrix. 

12380  MRT  S1'«<.5)«S1  I 

12390  ! 

12400  MRT  S2=*1NV<S1> 

12410  I 

12420  MAT  S1=«TRN<S:2)  ! 

12430  MAT  S2=*S1'*’9c;  !  Ensure  symmetric  matrix. 

12440  MRT  S2><.5>4S2  ( 

12450  ! 

12460  MAT  Kal«Pk»S2  !  Compute  Kalman  gain  matrix. 

12470  ! 

12480  MRT  Dev«Xk3"Xki  !  Deviations  between  states — <0bser . - i nteg.  state). 
12490  I 

12500  MAT  Corr»Kal *Dew!  Correction  vector. 

12510  MRT  Xk»XkifC:orr  <  Calc,  optimal  state. 

12520  MAT  Sl'*Kal»F'k  I  Calc,  updated  covariance  matrix. 

12530  MAT  Pk'»Pk-31 
12540  I 

12550  MAT  Sl  >TRN<F‘k> 

12560  MRT  Pk'>Pk-»31 


! 

I  Ensure  symmetric  matrix 
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12570  MAT  Pk-*<.5>*-Pk  I 

12580  ! 

12590  PRINT  IJSIN:  St>t>  Vectors _ 

Pi  f  _ " 

12600  PRINT  USIN:  "K";"  True  Int«g.  Proc .  B  Opt.  Est .  <I-7> 

<B-T)  CO-T)' 

12610  ! 

12620  FOR  I- I  TO  7 

12630  PRINT  USING  Form2: Xkt < I ) , Xk i < I > , Xkb< I > , Nk ( I > , Xk 1 < I >-Xkt < I >  ,  XkbC I >-Xkt  ( I  > 
,Xk<I>-Xkt<I ) 

12640  NEXT  I 
12650  ! 

12660  REPIN  ;<k(4> 

12670  NorM-S0R(P3T<Xk,Xk>> 

12680  PRINT  IJSINj  Forml;'*NorM  of  optimal  -  l:",NorM-l 

12690  NAT  Xk»Xk.^<Norir  >  I  Normal  i  z*  th«  optimal  aatimata. 

12700  REPIN  Xk(7> 

12710  ! 

12720  NAT  Xki«Xk  !  Sat  stata  >  optimal  stata...This  is  tha  starting 

12730  I  astimata  for  tha  naxt  frama. 

12740  I 

12750  Forml: (NAG-  /KX , NP. PPPPPPPP/ 

12760  Form2: [NAG-  7<NP.PPPE,X> 

12770  Forma: (NAGE  FCFP.  PPPE, X>/ 

12780  ! 

12790  PISP 
12800  SUBENP 
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Least 

Least  solves  the  least-squares  problem  for  differential  corrections 
to  the  Euler  parameters.  Formally,  the  solution  is: 

oe  =  (A^WA)"*  A^  WAX 

where  W  is  a  weight  matrix,  A  is  a  matrix  containing  partial  derivatives 
of  image  coordinates  with  respect  to  Euler  parameters,  and  AX  is  a 
vector  of  differences  between  measured  and  calculated  coordinates. 
However,  we  have  adopted  a  diagonal  weight  matrix  and  thus  absorb  the 
weights  into  A  and  AX  (in  the  calling  program).  Therefore,  we  write 

AB  =  (A^A)‘‘  A^  AX, 

the  form  used  in  this  subroutine. 

The  covariance-like  result  (A  A)"‘  is  returned  to  the  calling 
program  along  with  the  corrections,  A6. 


141 


************ 

* 

* 

* 

************ 

7610  !  This  routine  computes  < <RCtranspose}  •  fl>Cinuerse3>  *  flttransposeJ  ♦  Dy 

7620  !  where  Dy  is  the  uector  of  deuiations. 

7630  SUB  Least < , Dx< *) , Cou<*> , Oy <«> I Idi m, Jdi m> 

7640  OPTION  BflS£  1 

7650  DIM  Ti  CJdi  i),Jdiffl),T2<Jdiffi),Rt<Jdim,Idim> 

7660  ! 

7670  DISP  "Least* 

7680  > 

7690  MRT  Rt'=TRN<R) 

7700  MRT  Tl=»Rt*l 

7710  MAT  Cov*INi/<Tl>  !  Cou  ■  <RC transpose}  *  R  >£  inverse}. 

7720  MRT  T2:*Rt»0y 
7730  MAT  Dx=«Cow»T2 
7740  f 

7750  DISP 
7760  SUBENO 


■»***»a**«*««**«e*«««**«»««»««««««««««*«*******«**e 

* 

LEAST  » 

* 

>*«*»«'«*««««•«««***«**«»*«***»»**»«**««***««**»««* 


142 


Least-1 

This  subroutine  performs  an  iterative  least-squares  correction 
using  coordinate  data  from  one  field  of  view.  The  current  values  of 
are  passed  to  Least-1 ,  along  with  the  rotation  matrix  AV  or  BV  and 
the  matrix  containing  direction  cosines  and  measured  image  coordinates  for 
paired  stars  for  that  field  of  view.  The  corrected  Euler  parameters  are 
returned  along  with  the  covariance  matrix  result  from  the  least-squares 
correction. 

The  method  employed  is  to  first  call  Dircosb  to  compute  the 
rotation  matrix  VN  and  its  partial  derivatives.  Fill-y  then  computes 
the  differences  between  measured  and  calculated  image  coordinates. 

Pre-mult  converts  partial  derivatives  of  VN  to  derivatives  of  AN  or  BN  by 
multiplying  by  AV  or  BV,  respectively.  Dxdbeta  uses  these  partials  to 
compute  the  partials  of  image  coordinates  with  respect  to  Euler  parameters, 
The  last  row  of  the  derivative  matrix  is  filled  with  the  constraint 
equation. 

Finally,  subroutine  Least  is  called  to  compute  corrections  to  3^^^. 

If  these  are  small  enough  we  return  to  the  calling  program.  Otherwise, 
we  iterate  again,  up  to  a  limit  of  six  times. 


I 
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««**********'(««*  «**«*****««**«*•**«*»****«***««’«********« 

*  * 

*  LEflST-1  * 

*  * 

«*««*«****«*'(«««  »^'**«  ««»**«««*«««**«***«*«*******«****««*«**«* 

11480  SUB  Leist_l < Byr <*>, flv<*) , F 1 d<*> , Km*x, W, Cow<* >, Converge ) 

11490  OPTION  BftSZ  1 

11500  DIM  Sa-,'eb<4:  ,  Bs  < 4 )  ,  Dvn  1  <  3, 3>  ,  Dyn2< 3,  3 >  ,  Dwn3 (3,  3 )  ,  Dyn4 < 3, 3 ) ,  fln<  3 , 3 ) ,  Vn< 3 , 3 ) 
11510  DIM  Delx<4>,De1v<ll),fl<ll,4> 

11520  ! 

11530  MPT  Sayeb*6<.'n  I  Save  the  original  value*  of  Euler  parameters. 

11540  ! 

11550  PRINT  ijSIN:  "/K";"  Least-Squares  Correction  For  One  FOV” 

11560  FOR  It=l  T3  6 

11570  CALL  Dir:c.sb<Bvn<*), Vn<*), l,Dvnl<*>,Dun2<*>,Dvn3<*),Dvn4<*)) 

11580  MAT  An=A^iVn 

11590  I  sum-0 

11600  REDIM  Dei  v<Ktrax*2) 

11610  CALL  Fin  yCF  ld<*),Kmax,An<*),De1i;<»>,  Isum> 

11620  Sql=SQR<D0T<re1v<,Dely)/<Kmax«2)> 

11630  PRINT  USING  'V ,  K ,  D .  DDDDE  “  ;  "RMS  error  for  normalized  image  c  oord  i  n«.t  es :  " , 
Sql 

11640  ! 

11650  REDIM  R<<max«2+l,4),Dely<2*Kmax+l> 

11660  CALL  Pre  mu  1 1 < Av < *) , Dvn 1 < * ) , Dvn2< * > , Dvn3( * ) , Dvn4 <♦ > ) 

11670  CALL  Dxd3«ta<Fld<*),A<*),Kmax,An<*>,Dvnl<*>,Dvn2<*>,Dvn3<*>,Dvn4<0> 
11680  ! 

11690  FOR  1  =  1  rci  4 

11700  A<;2*Kma>;+l ,  I  )“2*W*Bvn<  I )  !  Constraint  equation. 

11710  NEXT  I 
11720  ! 

11730  Del v:2*Knax+l )=W*< l-DOT<Bvn,Bvn>> 

11740  ! 

11750  CALL  Least <A<*),Delx<*),Cov<*),Dely<*>,Kmax*2+l,4) 

11760  ! 

11770  MAT  :3s=B>ri 

11780  PRINT  USING  'V,K“;"  Beta<old>  BetaCnew)  De1ta<Beta>" 

11790  FOR  1=1  TO  4 

11800  Bvn<I)=l!vn<I)+Delx<I) 

11810  PRINT  JSING  " X3<MD. DDDDDDD, XXXX> " ; Bs< I > , Bvn< I > , De 1 x ( I > 

11820  NEXT  I 

11830  Dev=SQR<DCiT<Ielx,Delx)/4) 

11840  PRINT  USING  'V, K, D. DDDDE" ; "RMS  change  in  Euler  parameters;  ",Dev 
11850  ! 

11860  IF  D>?v<  1  i- 6  THEN  Morestars  !  Small  c  orrec  t  i  ons .  .  .  ex  i  t  loop. 

11870  NEXT  I- 
11880  ! 

11890  Nosol n:  PRINT  "♦**♦*♦  LEAST-SQUARES  FOR  ONE  FOV  DID  NOT  CONVERGE  **«*«*" 
11900  Converge*^  !  Failure  of  least-squares. 

11910  MAT  ;3vn=3avet  !  Replace  Euler  parameters  with  original  values. 

11920  MAT  Cov-ZER 

11930  PRINT  USING  Forml ; "Number  of  i terat 1 ons: ",  1 1-1 , Converge 
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11940  SUBEXIT 
11950  I 

11960  Merest  »rs:  Con«,erge*l 

11970  tlRT  Co^^«'c>w**<Sql*Sql  >  I  Compute  cou.  matr  i  x.  .  .  mul  t .  by  sigm«e* 
11980  PRINT  USING  Forml ; "Number  of  1  ter mt Ions: ”,  1 1 , Converge 
11990  Forml:  IMAjE  K, X, DD, XXX, "Conuergeo" , D 
12000  ! 

12010  SUBENO 
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Least-2 

Least-2  updates  the  Euler  parameters  and  3g^  via  least-squares 
differential  correction,  using  between  3  and  5  matched  stars  from  each 
FOV.  Both  and  should  initially  be  very  near  their  final 
corrected  values  has  been  corrected  by  Pair-It  and  Bg^^  does  not 
vary  rapidly);  thus  the  least-squares  requires  only  2  or  3  iterations 
to  converge.  Since  this  also  means  the  derivatives  do  not  vary  substan¬ 
tially  between  iterations,  we  can  use  the  secant  method  (subroutine 
Secant)  to  update  the  matrix  of  partial  derivatives  used  in  the 
least-squares. 

As  input  we  pass  the  current  values  of  Byj^  and  Bg^  and  the  arrays 
containing  the  direction  cosines  and  measured  coordinates  for  up  to  5 
stars  per  FOV.  We  return  the  updated  Euler  parameters  and  Bg^^  and 
the  4  X  4  covariance  matrix  associated  with  B^j^.  For  each  least-squares 
iteration  we  compute  the  differences  between  measured  and  calculated 
images  for  corresponding  stars  and  the  change  in  these  differences 
compared  with  the  previous  iteration  (to  be  used  by  Secant) .  On  the 
first  iteration  we  calculate  the  exact  derivatives  of  image  coordinates 
with  respect  to  both  and  6g^  (via  calls  to  Dircosb,  Mat-av, 

Pre-mult,  Post-mult  and  Dxdbeta  -  see  Appendix  7).  The  last  several 
rows  of  the  derivative  matrix  are  filled  with  the  constraint  equations, 
one  for  each  set  of  Euler  parameters  (multiplied  by  an  appropriate 
weight)  Bg^,  see  Section  3  and  Appendix  7).  A  call  to  Least  returns 
corrections  to  all  eight  Euler  parameters;  if  these  are  small  we  return, 
otherwise  we  iterate  again,  using  Secant  to  update  derivatives. 
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***«*•« *4**« '**»*»**««*«*«***««***«*«*« *««*«*****«««*****«**«* 

»  * 

*  LEflST-2  • 

«  « 

*•**»*•*•**«>«•*»«■*««**«****«**»*«*«****«»«**«*«»•**«******«* 

15180  SUB  Le  isi_2<  Bvr <♦ ) , Bb*<« ) , Ka, F 1 da<») , Kb, F 1 db(* > , M, Cov8< *) > 

15190  OPTION  BflSi  1 

15200  DIM  n<:>6,8>,De1 v<26>,Ddy<26>,8t 1< 10,4 >,Rt2< 10,4 >, Del x(8>,Bbasave<4> 

15210  DIM  Rn:3,3>,Bn(3,3> 

15220  DIM  flw:3,3),Da^l<3,3),Dav2<3,3),Daw3<3,3),Daw4(3,3> 

15230  DIM  Ba:3,3>,Dbal<3,3),Dba2<3,3>,Dba3<3,3>,Dba4<3,3> 

15240  DIM  Vn:3, 3>, Dvr  1(3,3), Dvn2<3,3>,Dvn3<3,3>,Dw>n4(3,3> 

15250  ! 

15260  PRINT  USIN:  Least-Squares  Correction  For  Two  FOV 

15270  PRINT  iJSINj  ,  K ,  D,  K ,  D,  K"  ;  "Correc  t  orientation  using  '■,Ka,"  stars  from  FOV 

<R>  and  ",Kb."  stars  from  F0V<B).” 

15280  Sqts»li:40 
15290  Ka2>Ka>Ka 

15300  Kb2>Kb>Kb  I  Set  up  some  constants  and  dimensions. 

15310  Kk-Ka2>Kb2 
15320  Ipass2-1 
15330  Jdim>8 
15340  ldim-K»2  +  K3;;+2-*4 
15350  ! 

15360  REDIM  R< I d i m, Jc i m) , Ddy ( Idi m) 

15370  MRT  Dely»ZIP 
15380  MRT  R».2ER 

15390  MAT  Cov8»2if;  !  Initialize  some  matrices. 

15400  MRT  Bbasav?>'Bbc.  !  Saue  Euler  parameters  in  case  of  failure. 

15410  ! 

15420  ! 

15430  FOR  It=l  TO  4 
15440  Exact:  \ 

15450  l:>um«3 

1 5460  CALL  Di rccsb<BMn<»)  ,  Vn<*) ,  Ipass2,  Dvnl ( *>  ,  Dun2( *)  ,  Dun3( ,  Dun4(^ ) ) 

15470  CALL  Oirccsb<Bba<*),Ba<*), I pass2, Dbal < * > , Dba2( * ) , Dba3 ( * > , Dba4 ( * ) > 

1 5480  CALL  'ljit_e.u <  Ba<  *  )  ,  Dbal  <  *  )  ,  Dba2<* )  ,  Dba3 (  »  >  ,  Dba4  <  ♦  >  ,  Rv <  ♦  )  ,  I  pass2 ,  Dau  1  ( * 

>,  Dau2(*>,  Dau3<*> ,  Da<.4(*>  > 

15490  MAT  Ri'iRueVn 

15500  MAT  B't>Ba«Rn 

15510  REDIM  Dcy(Kk>,De1y<Kk) 

15520  MRT  Iidy*Dely 

15530  CALL  - i 1 l_y <F1 da< * ) , Ka, Rn(e ) , De 1 y<*) , I  sum)  !  Deviations  for  F0V<R). 

15540  CALL  -ill  y <F 1 db< * ) , Kb,  Bn< *) , De 1 y <* )  ,  I  sum )  !  Deviations  for  F0V<B>. 

15550  MAT  Ddy»Dcy-Dely 

15560  Sqt=S3P(DCT<Dely,Dely)/Kk  > 

15570  PRINT  USIKG  'V, K, X, D. DDDDE" ; "RMS  error  in  normalized  image  coordinate 

s:  Sqt 

15580  IF  Sqt<Sqts  THEN  Decreasing 

15590  Ipasi2Bl  !  Flag  to  compute  exact  derivs.  because  the 

15600  Sqts>lE40  I  image  error  is  increasing. 

15610  G0T3  Exact 
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15620 

15630 

15640 

15650 

15660 

15670 

15680 

15690 

15700 

15710 

15720 

15730 

15740 

15750 

15760 

15770 

15780 

15790 

15800 

15810 

15820 

15830 

15840 

15350 

15860 

15870 

15880 

15890 

15900 

15910 

15920 

15930 

15940 

15950 

15960 

15970 

15980 

15990 

16000 

16010 

16020 

16030 

16040 

16050 

16060 

16070 

16080 

16090 

16100 

16110 

16120 

16130 

16140 

16150 

16160 


Dtcr**:>ing:  !  Com*  her*  is  solution  is  converging. 

Sqts*3c|t 
RIIDIM  HdyCIdim) 

II-  Ips!'S2*2  THEN  S*csnt_ffl*thod 
Ipsss2*'2  I  ” 

!  Cowpute  partial  derivs.  of  <x,y>  for  F0V<fl>. 

CULL  ^re_i*  ul  t<fiv<*>,Dvnl<*>,  Dvn2<*  >  ,Dwn3<*>,Dvn4<*)> 

CHLL  =ost_mul t  < Vn<#> , Davl < *> , Dau2< *> , Dav3(*> , Dav4(»> ) 

CRLL  D>:db«  t  a<F1  da<*)  ,  Rt  1  (« )  ,  Ka,  HnC * > ,  Dvnl  <*>  ,  Dvn2<«>  ,  Iivn3<*  ) ,  D',  ri4  <*  > ) 
CrtLL  D>;db€ta<F1  da<*) ,  flt2<*) ,  Ka,  ftn<*)  ,  Dawl  (*> ,  Dav2(*> ,  rav3<*) ,  Dc.v4<*) ) 


FOR  lal  TC  4 
FOR  K*!  TO  Ka2 

RCK, I>=fltl<K, 1>  !  Fill  fl<»>  with  F0V<fl>  derivatives. 

I-*4)»flt2<K,  I) 

NEXT  K 
NEXT  I 

j 

!  Campute  partial  derivs.  of  <x,y>  for  F0V<B>. 

CrtLL  ’r  e_iif  ul  t<Ba(*),Dvnl<*),  Dvn2<*>  ,  Dvn3(*>,Dvn4<*>> 

CRLL  =c.st_^mult<Rn<*),Dbal<*),Dba2<»>,Dba3(*>,Dba4<*)> 

CRLL  e_(» u  1 1  < Ba< *) ,  Davl  <») ,  Dav2( *> ,  Dav3(* ) ,  Dav4<*>  > 

MRT  D3<i1  =Ibal -fDavl 
MRT  D3<i2=rba2-*-Dav2 
MRT  D3a3  =  Iba3-t-Dav3 
MRT  D3ii4=Iba4  +  Dav4 

CRLL  0>:db«t  a<Fl  db<*)  ,Rtl<*),Kb,Bn<»),Dvnl<*),  Dvn2(*) ,  Dvn3<  *> ,  D'.  n4<.  ♦'i  > 
CRLL  0>:db€ta<Fldb<*),Rt2<*),Kb,Bn<*>,Dbal<*),Dba2(*>,Dba3<*),Dta4(rt)) 


FOR  1=1  TC  4 
FOR  K*!  TO  Kb2 

R<Ka2+K, I)=fltl<K,  I) 
fl<Ka2-*K,  I+4>»flt2<K,  I  ) 
NEXT  K 
NEXT  I 


GOTO  .sq 
Secant  met  TCid:  ! 

CRLL  3<-cart<fl<*),Delx<a),  Ddy  <  •>  ,  Idim,Jdini> 
Lsq:  ! 

RliOIM  IieH^Idim) 


!  Fill  fl(*)  with  FOVCB)  derivatives. 


FOR  1=1  TC  4 

R<K<h 1, I)-Bvn<I>*W*2 
R<K<-t  1 , 4  +  1  >»0 
R<K<+2,4+I)*Bba<I)*W*2 
R<K<+2, I )*0 
NEXT  I 
I 

D.jly<  <1  +1  )«We<  l-DOT<Bvn,Bvn)> 
D>>ly<  <l<  +2>>U*<l-D0T<Bba,Bba>> 
MRT  0dV'”D*1y 


Constraint  eq.  for  Bvn. 
!  Constraint  eq.  for  Bba. 


I  More  constraint  eq. 


Ci^LL  .east  (R<  *> ,  D*  1  x<e> ,  Cov8<«> ,  D*ly<*>,  Idim,Jdim) 
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16170  ! 

16160  PRINT  USIl'C  Eu1«r  parAmcttrs  *nd  correct  i  on»:  “ 

<V-N>  d*Uk-B(i/>N>  B<B-R>  dtU«>B<B-n>" 

16190  I 

16200  FOR  I>1  TC  4 

16210  Bvn<l  >-Ew*n<n-»De1x<I> 

16220  Bb*<] >-Eba<l>+De1x<4>I> 

16230  PRUT  USING  "4<MD.  DDDDDDD,  XX>  "  ;  Bvn<  I  > ;  De  1  x<  I  >  ,  Bb*<  1 )  :  Be  1  x<4+l  ) 

16240  NEXT  I 

16250  I 

16260  D<?v;-S3R<DCT<De1x,0clx)/^8) 

16270  PRINT  USING  K, X, D.  DODBE" ; "RMS  change  in  Euler  paraueters: " ; Deu 

16280  II-  DcJ<lE-7  THEN  Covariance 

16290  NEXT  It 

16300  GOTO  Two  failed 

16310  ! 

16320  Covariance:  ! 

16330  PRINT  "  <End  of  1  east -squares  for  two  FOV)" 

16340  MRT  Cov8*CovS*<Sqt'^2>  !Mu1 1 .  <RCtranspose]*R><  i  nverse)  by  sigma''2. 
16350  !  PRINT  USING  "8<MD. DDE, X) ; Cov8<*> 

16360  SUBEXIT 

16370  Two  fai led:  ! 

16380  PRINT  LERST-2  FRILED 

16390  ! 

16400  SUBENO 
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Mata 

This  subroutine  computes  part  of  the  right  hand  side  of  kinematic 
differential  equations  governing  Euler  parameters.  For  input  data  Mata 
requires  the  current  Euler  parameters,  the  rate  gyro  data  and  the 
rotation  matrix  VG  to  rotate  the  gyro  rates  from  the  gyro  to  vehicle 
frame.  We  can  express  the  differential  equations  as 

{3}  =  [w]a 
=  [6]a) 

(see  Section  4  and  Appendix  8  of  the  Final  Report  for  details);  Mata 
fills  matrices  [to]  and  [a].  These  two  forms  are  also  needed  for 
integrating  the  matrix  Riccati  equation  for  covariance  propagation. 
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*  n  R  T  R 

* 

«#«*«**««****»***«»»**»****•«*«•»»****** 


12890  SUB  l1a;a<F,l>l<*>,X<*>,Rll<*>,R12<*>> 

12900  OPTION  BRSE  1 
12910  con  Vg;3,3} 

12920  Bin  Rl;>p(4,:i>,l>v(3> 

12930  I 

12940  NRT  Mv;^>Vg«4 
12950  MRT  M<^'>Uw>*<.5> 

129€0  Ml-Uv< l> 

12970  U2«M>^<;>) 

12980  M3»Uw<3> 

12990  ! 

13000  I  Calc. 

13010  ! 

13020  ! 

13030  R11<1, l>«0 
13040  fill<l,;>)»-41 
13050  Rll<l,3>*-4:; 

13080  Rll<l,4>*-43 
13070  • 

13080  Rll<2,  D-Ul 
13090  Rll<2,:2)«0 
13100  R11<2,3>«M3 
13110  Rll<2,4>«-42 
13120  ! 

13130  Rll<3, 1>«U2 
13140  flll<3,2)=-4:i 
13150  Rll<3,:3>«0 
13160  R11<3,4>>M1 
13170  I 

13180  Rll<4, 1>>M3 
13190  Rll(4,:>>-U2 
13200  Rll(4,3>  — 41 
13210  Rll<4,4>-0 
13220  < 

13230  IF  F«0  THE4  SUiEXIT 
13240  I 

13250  !  Calc,  matrix  R12  «  -DC (BO,  B1 , B2, B3)D0T)/D<M1 , M2, M3> 

13260  <  -  D<<B0,B1,B2,B3>D0T>/D(bl,b2,b3> 

13270  I 

13280  B0-X<1 >*.5 

13290  Bl-X<2)*.5 

13300  B2-X(3>*.5 

13310  B3»X(4>*.5 

13320  ! 

13330  R12p<l , 1)-B1 
13340  R12p<l ,2>-B2 
13350  R12p<l  ,3>-B:< 


I  Rotate  gyro  rates  into  V  frame. 

I  Divide  by  2  now  instead  of  later. 


matrix  R1 1»D< CBO, B1 , B2, B3>D0T>/DCB0, B1 , B2, B3> 

where  B0,B1,B2,B3  are  Euler  parameters. 
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I 

I 

I 

I 

I 


133£e  t 

13370  A12p<2, 1>--Ii0 
13380  ni2p<2,2>-B3 
13390  R12p(2.3>*-li2 
13400  ! 

13410  R12p(3, 1>>-It3 
13420  R12p<3,2>«-1!0 
13430  f)12p<3,3>-B> 

13440  ! 

13450  ni2p<4, 1>-B2 
13460  R12p<4,2>--lil 
13470  R12p<4,3>--li0 
13480  ! 

13490  MAT  R12aR12p«V{  !  Multiply  by  rot*tlon  matr 

13500  I 

13518  SUBEND 


1 


1 


1 

1 
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Mat-av 

This  subroutine  calculates  the  rotation  matrix,  AV,  between  the 
vehicle  and  star  tracker  (A)  frame.  The  matrix,  BA,  between  star 
tracker  frames  is  required  for  input.  If  selected,  the  partial  deriva¬ 
tives  of  AV  with  respect  to  elements  of  BA  are  calculated.  (See 
Appendix  7  for  details). 
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*«»«*«**»*««•»***»«'*»«*»**««««*«*«««’*««««*««»«««««*«««*******»» 
«  * 

*  l'flT_flV  ♦ 

*  “  # 
**«**«««*««*  (*»«»*'«*««**««*««**«**««*«*«4tX  *«««*«**•«««*•««««•* 


10220  SUB  Ma;  av<l:&(«  > ,  Dba0<«> ,  Obal  <*> ,  Db*2<« > ,  0b*3<:«> ,  RvC*) ,  Der ,  Dav0<*> ,  IamI  < *> 
,Dav2<*>,Dav:3T*>> 

10230  OPTION  BRS-  1 

10240  DIM  T1  :3,3),T2<3,3>,T3<3,3>,T4<3,3> 

10250  ! 

10260  DISP  "Mat  av" 

10270  ! 

10280  D1»1/'SQR<24-2*B«.<3,3>)  I  Two  uaaful  factors. 

10290  D2*l/SQR(2-2«Ba<3,3>) 

10300  ! 

10310  Ro< 1 , 1 >aBa<3| 1 )«D1  !  Comput*  matrix  RV  from  BR. 

10320  Rw<2, 1 >sBa<3,2>*Dl 
10330  Rw<3, 1  >«.5^Iil 
10340  ) 

10350  Rw<l,2)«Ba<3, 1>*D2 
10360  Ro<2,2>>Ba<3,2>«D2 
10370  Rv<3,2)»-. 3/D2 
10380  ) 

10390  Rv<l,3>«-2»lsa<3,2>«01*D2 
10400  Ro<2,3>»2*Ba<3, 1>«D1«B2 
10410  Rv(3,3>»0 
10420  ! 

10430  OISP 
10440  ! 

10450  IF  BcrOl  THEN  SUBEXIT 
10460  I 

10470  DISP  "Mat  av" 

10480  ! 

10490  MRT  T1==2ER 
10500  TKl,  1  >sDl 
10510  Tl<l,2>-D2 
10520  T1(2,3>«2*OJ»02 
10530  ! 

10540  MRT  T2>ZER 
10550  T2<2,1>-T1<1,1) 

10560  T2<2,2>-T1<1 ,2> 

10570  T2<1,3)— Tl<2,5) 

10580  ! 

10590  T3<1,  1  >— R^<  1,  1>*D1»D1 
10600  T3<2,  1  >— Rv>(2,  1>*D1*01 
10610  T3<3,  1  >>.5»Iil 
10620  T3<l,2>-Rv< J ,2>*D2*02 
10630  T3<2,2>-Rv<:-,2>tD2«02 
10640  T3<3,2>*02».5 
10650  T-Ba<3,3>*3« <01*02)^3 
10660  T3<l,3>»Ba<3,S>*T 
10670  T3<2,3*-Ba<3, t>«T 

1 


I  L*av«  SUB  If  wt  don't  nttd  partial*. 


!  Compute  d<RV(«>  )/'d(BR(3, 1  >  > . 


!  Compute  d<RV<*>>/'d<Bfl<3,2>>. 


!  Compute  d(RV(*>>/'d<BR<3,3)>. 
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10680 

10600 

10700 

10710 

10720 

10730 

10740 

10750 

10760 

10770 

10780 

10790 

10800 

10810 

10820 

10830 

10840 

10850 

10860 

10870 

10880 

10890 

10900 

10910 

10920 

10930 

10940 

10950 


T3(3,3>"0 

I 

MRT  Da'>0»Tl«  <0ta0<3, 1>> 
M8T  T4>«T2*<Iib«C<3,2>> 
MAT  0«vO«Dft«.<0'«’T4 
MAT  T4>*T3*(I)b«e<3,3>} 
MAT  D*v0a0Ev0>T4 
! 

MAT  D*-^l-Tt«<0bEl<3,l>> 
MAT  T4'»T2*<libEl<3,2)) 
MAT  D»>>1>Dev1+T4 
MAT  T4»T3»<lib«l<3,3)) 
MAT  DEV1-DEVUT4 

MAT  Da'>2=Tn  <Dta2<3, 1)> 
MAT  T4'»T2*<libE2<3,2)) 
MAT  Dav2-Dav2+T4 
MAT  T4!aT3*<IibaS<3,3>> 
MAT  8a>^2-DEv2-fT4 

t 

MAT  Day3*TH  <Dta3<3,  1>> 
MAT  T4=«T2*<Iiba2<3,2)) 
MAT  0av3B0av>3-*’T4 
MAT  T4=«T3*<liba:-<3,3)) 
MAT  Dav3»Da<.*3*T4 
( 

DISP 

$UB£ND 


I  Coaput*  d<AV<*>>xd(Bba<l>>. 


•  Compute  d<AV<»>>^d(;Bba<2>>. 


!  Compute  d<AVC*>  >/'d(Bba<3>  > . 


!  Compute  d<AV<*>  >/'d(Bba<4>  >  . 


Orbit 


We  use  Herrick's  "f  and  g"  solution  for  a  two  body  case  (see 
Reference  6)  to  update  the  satellite  and  earth  position  and  velocities. 

For  either  the  satellite  or  earth  we  set: 

1  ! 

ro  =  (Ho  •  Lo)  ^  (Xo.Yo.Zo)  =  initial  position 

=  (X§  +  Y§  + 

Vo  =  (Vo  •  Vo)  =  (f^o  •  £0)  (^oJo*to)  =  initial  velocity 
=  (Xg  +  n  + 

Do  =  r.0  •  V.0 

=  XoXo  +  YoYo  +  Zoio 
1/a  *  2/ro  -  Vo/u 
u  =  GM 

to  =  initial  time 

In  the  current  version  of  this  program  we  have  set  both  orbits  to  be 
circular.  The  inclinations  of  the  earth  orbit  is  23.5°  and  the  satellite 
orbit  is  70°. 

To  obtain  the  position  and  velocity  of  either  body  at  some  later 
time,  t,  we  solve  the  following  equation  for  M  •'y  Newton's  method: 

u  ^^(t  -  to)a~V2  =  M  -  (1  -  ro/a)sin  M  +  Do(l  -  cos  M)(ua) 

using  the  initial  estimate: 

M  =  u  ^^(t  -  to)a” 

Then,  the  position  (X,Y,Z)  at  time  t  is: 

t 


I 
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where 

f  =  1  -  a(l  -  cos  M)/ro 
g  =  (t  -  to)  -  a  -  sin  M)u“V2 

Also,  the  velocity  (X.Y.i)  at  time  t  is: 


where  r  =  (X^  +  +  Z^) 

f  =  -(ua)  sin  M/rro 
g  =  1  -  a(l  -  cos  M)/r. 
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*  * 

*  ORBIT  * 

*  * 
****»****«»*>***»'•'**«*******«*'»*««*«***««*«*«•«««**«*«««*«***«* 


16490  !  This  subroutine  computes  the  orbitAl  position  and  uelocity  using 
16500  !  Herrick's  F  s.nd  G  solution.  <See  J.L.Junkins  Text) 

16510  ! 

16520  SUB  Orbit<r,P<«),V<*),P0<*),V0<*),T0,U,fl,D0,R0> 

16530  OPTION  BRSZ  1 
16540  DIM  PI :3>, »2<3) 

16550  ! 

16560  X-l-RO'fl 
16570  Y»D0>'Si)R<U»H) 

16580  Rho=SQR«:U)*<  T-Ta)/SQR<fl*fl*fl) 

16590  PhiaRho 
16600  DphialO 
16610  I 

16620  FOR  I=l  TO  10  I  Find  Phi  by  Newton's  method. 

16630  CphiaCOSCP-ii  ) 

16640  SphiaS(N<Poi ) 

16650  IF  RBS:Dphi ;<lE-5  THEN  Got_it 
16660  Rhoc=Plii  -X»Sphi  ♦?*<  1-Cphi  > 

16670  Drdp=l -X*Cohi +T*Sphi 
16680  Dphi =<Rho-?hoc )/Drdp 
16690  PhiaPhi+Dp-ii 
16700  NEXT  I 
16710  ! 

16720  PRINT  •♦**n**«»*  help  **##«»»##*  ORBIT  DID  NOT  FIND  PHI  MM!!!!!! 
16730  I 

16740  Got  it;  !  Newton's  method  worked. 

16750  F=l~fl*  :  1-Cohi  >-'R0 

16760  G-T-T0-ft*S3P<fl^U)*<Phi-Sphi ) 

16770  MAT  Pls<F)»F-0  ! 

16780  MAT  P2-<G)»V0  I  Update  position. 

16790  MAT  P=P1+P2  I 

16800  I 

16810  R«SQR<:)0T<’,P)> 

16820  Fd*-SQR<U*^:*S|:hi/<R*R0) 

16830  Gd*l-At< l-:phi )/R 

16840  MAT  Pl»<Fd)*P0  ! 

16850  MAT  P2'*<Gd)^V0  I  Update  uelocity. 

16860  MAT  V-P1+P2  ! 

16870  ! 

16880  SUBEND 
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Pair-it 

The  task  of  Pair-it  is  to  identify  measured  stars  with  specific 
catalog  stars.  We  do  this  in  two  ways.  The  first  method  compares  the 
cosine  of  the  interstar  angle  between  measured  star  pairs  with  the 
cosine  of  interstar  angles  of  catalog  star  pairs.  If  there  is  a  match 
we  perform  a  least-squares  correction  (by  calling  Least-1 )  to  refine  the 
attitude  estimate. 

The  second  method  to  match  stars  uses  the  improved  attitude  esti¬ 
mate  to  mathematically  project  all  the  sub-catalog  stars  onto  the  focal 
plane  and  then  compare  each  position  with  measured  stars.  We  require  at 
least  three  matches  to  confirm  the  attitude  found  by  least-squares.  The 
direction  cosines  and  measured  coordinates  for  each  confirmed  star  image 
(up  to  5  stars)  are  stored  in  an  array  and  returned  to  the  calling 
program  for  later  processing. 

The  confirmation  tests  discussed  above  require  an  error  tolerance 
between  projected  and  measured  stars  in  order  to  accept  or  reject  a 
specific  catalog  star.  The  technique  we  use  is  discussed  below.  We 
first  calculate,  for  one  star  of  the  initial  matched  pair,  the  angular 
size  of  twice  the  estimated  one-sigma  error  (10%  pixel)  as  seen  from 
the  midpoint  between  images  and  perpendicular  to  the  line  connecting  the 
two  stars.  Then,  for  stars  more  distant  than  one-half  the  pair  separation, 
we  scale  the  angle  by  the  distance  from  the  midpoint  in  order  to  get  the 
tolerance  for  each  star.  For  nearer  stars  we  simply  use  the  estimated 
two-sigma  image  error.  This  technique  helps  to  account  for  rotation 
errors  due  to  displacements  of  one  or  both  stars  of  the  initial  pair, 
normal  to  the  separation  vector.  (See  Figure  A10.3). 
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tan  E  =  e  ==  2a/p 

where  p  =  one-half  of  separation  between  the  initial  matched  pair 
and  o  =  estimated  error  (1 -sigma)  in  position  of  star  centroid. 
2a'  =  ep'  (for  p'  >  p) 

2o"  =  2a  (for  p"  ^  p) 

where  p'  and  p"  are  distances  from  midpoint  (x^^.y^,)  between 
stars  of  initial  pair. 

Figure  A10.3:  Calculation  of  error  tolerance  values  to 


be  used  for  matching  measured  and  calculated 
star  images. 


«***»*****•«'»***  »«■*««  *««**«*««*««****«**»«******************** 

*  * 

»  P  fl  1  R  -  1  T  * 

»  « 

**»**»***tt**4*** »*■**« ***«***«***««**«««**««**»******«*«****««* 

4620  I  Pair_it  oairs  stars  from  the  catalog  and  stars  from  Proc .  fl  to  fird 
4630  !  the  or  i  e-it  at  i  on  of  the  vehicle. 

4640  SUB  Pal r_i l < SHCRT  Fovc<*)iREflL  Nf owe , Fowm< * > , Nf ovm, BvnCe > , flv< ♦ ) , Tol , S i gxy , 
FI  ,W,Fld<#>,l<max) 

4650  OPTION  BASE  1 

4660  DIM  Vn:3,3),fln<3,3>,Sb<4) 

4670  DIM  Xx:2>, 0ist<5),L<3),Cow<4,4>.T<3,3> 

4680  SHORT  CosmC^ S> , Epsp<45> 

4690  INTEGER  Ind>:(4:,2> 

4700  RflD 
4710  ! 

4720  MAT  Sb'<6wn  !  Save  original  values  of  Euler  parameters. 

4730  Cosmax:>COS<F'I/180) 

4740  Cosmin»COS<J  UFIz-iaO) 

4750  Ll-1 
4760  ! 

4770  MmaNf ovm+Nf ovm- 1  !  Maximum  sum  of  indices  for  measured  stars. 

4780  PRINT  USIN:  K" ; "Tabl  e  of  Cos<Theta>  for  Measured  Stars.” 

4790  PRINT  USIN:  For m2 

4800  Form2:  (MAGE  "  Star  Star  Cos<Theta>" 

4810  ! 

4820  FOR  Ms3  TO  Mm  !  Loop  over  all  possible  sums  of  indices  for 

4830  =  !  measured  stars. 

4640  FOR  TO  J1  I  Loop  over  all  pairs  whose  indices  sum  to  M. 

4850  K*M-J 

4860  IF  K>Nrc.vm  THEN  GOTO  Nextj 

4870  Cosm<L I  I  "Fc vm< J , 3>*Fowm<K, 3)*<Fowm<  J, 1 ) *Fowm<K , 1 >  +  Fovm<  J , 2> »Fovn  <K , 2 )  + 

n 

4880  IF  Cosfl« LI ) >Cosmax  THEN  GOTO  Nextj 

4890  PRINT  JSING  Form  1 J J; K; Cosm<L 1  ) 

4900  Forml:  (MAGE  2X, DDD, 2X, DDD, 3X, D. DODODD 

4910  In.dx<L1,l>»J 

4920  Indx<Ll ,2)»K 

4930  Ll=Ll+l 

4940  Nextj:  NEXT 

4950  NEXT  M 

4960  Imax'>L1-l  !  Total  number  in  list. 

4970  ! 

4980  Mm=Nfovc-*-Nfowc- 1  !  Maximum  sum  of  indices  for  catalog  stars. 

4990  PRINT  iJSINj  , K" ; "Begi n  Pairing  Catalog  Stars  and  Comparing  To  Measured  P 

airs.  ” 

5000  PRINT  USINi  "/K , X, DDD" ; "Number  of  stars  from  cat al og: " , Nf ovc 
5010  PRINT  USINI  Form2 
5020  ! 

5030  FOR  I1’>3  TO  Mur  !  Loop  over  all  possible  sums  of  indices  of 

5040  Jl=<M-i;x2  !  catalog  stars. 


5050  FOK  Jj=l  TC  J1  !  Loop  over  all  pairs  whose  indicts  sum  to  M. 

5060  KaM-J, 

50?0  (F  K>Mfo».c  THEN  GOTO  Nextjj 

5080  Cost  *(i 

5090  FOR  .*=1  TO  3 

5100  Cost «Ccst +Fouc < J j , L)»Fowc <K, L>  !  Compute  dot  product. 

5110  NEXT  L. 

5120  PRINT  USING  Form  1 ; Jj ; K; Cost 

5130  IF  CDs.t>Cosmax  THEN  GOTO  Nextjj 

5140  (F  C3£.t<Cosmin  THEN  GOTO  Nextjj 

5150  FOR  Ii=l  TO  Imax 

5160  IF  fiBS<Cost-Cosm<  I  i  >  XTol  THEN  Hatch  !  Test  For  match. 

5170  Next i i :  HEXT  I i 

5180  Nextjj:  'ir.XT  Jj 

5190  NEXT  H 
5200  ! 

5210  Failed:  PRINT  "**«*»****»*  NO  PAIR  HATCH  FOUND  FOR  THIS  FOV  ***»***4.  *****  •• 
5220  Kmax-O 
5230  SUBEXIT 
5240  ! 

5250  Hatch:  PRINT  LSING  "x , K" J “ >>>>>  Catalog  Pair  Hatched  with  Measured  Pair  < 

<<<<•■ 

5260  t<ms>:a2 

5270  Iml*:Incx<  I  i ,  1 ) 

5280  Im2*’Incx<  I  i ,  2) 

5290  Icl*:Jj 

5303  lc2«iK 

5310  IF  F  outr  <  Iml ,  4  XFoumC  Im2»4)  THEN  0km  \  Test  magnitude  order. 

5320  Ii.alrrl 

5330  lml=Im2  !  Switch  magnitude. 

5340  Ihi2als 

5350  0km:  IF  Fo  .>c  <  I  c  1 , 4  XFouc  <  Ic  2, 4)  THEN  Okc  I  Test  magnitude  order. 

5360  Is.alcl 

5370  Ic lalc2  !  Switch  magnitude. 

5380  Ic2-Is 

5390  Okc:  PRINT  JSING  "xK" ; "Measured  pair:" 

5400  PRINT  JSING  Form2 

5410  PRINT  JSING  Forml ; Iml ; Im2; Cosm< I i > 

5420  ! 

5430  !  Conpute  separation  of  pairx2. 

5440  I 

5450  Rhol2a;;QR<  <F  ovit  <  1ml ,  1  >-Foum<  Iffl2, 1  >>^2-KFowm<  Iml ,  2>-Fowm<  lm2, 2)  >''2>x2 
5460  ! 

5470  !  Conputc  angular  extent  of  2*sigma  error. 

5480  ! 

5490  Epsa2*Sigx.;x(F1*Rhol2> 

5500  Xcenta IFouet Iml , 1 >*Foum< Im2| 1 > >x2  !  Compute  average  position. 

5510  Ycent*  :Fow»< Iml , 2)*Foum< Im2,2>  >x2 
5520  I 

5530  Fld<l, 1>«F3uc<Ic1,  1) 

5540  F1d<l,;2>«FDuc<Icl,2) 

5550  FId<l,  :})aFDvc<Icl,3) 

5560  FI d< 1 « 4>aFoum( Iml , 1 > 

5570  F1d<l,:5>aF3um<Iml,2>  ! 

5580  F 1 d<2| I > aF SVC ( lc2f 1 >  •  Fill  array  with  data  for  paired  stars. 
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5590  Fld<2,;>>*F3vc<Ic2,2)  I 

5600  Fld<2,;J)=F3vc<Ic2,3) 

5610  Fld<2,4)«F3k-m<Im2,  1) 

5620  F1d<2,!5>>F3>.>m(lin2,2> 

5630  I 

5640  !  Pt'fortr  1  •ast-squar*ft  di  f  ftrent  i  a1  correction. 

5650  ! 

5660  CALL  L>?ast  _l  <Bv.n<*)  ,  Ay<  *>,  FI  d<»>  ,  Ktn»x,  M,  Cou<  *>,  Converge) 

5670  IF  Convergf»:0  THEN  Next  i  i  I  Tr>;  Another  pai  i - this  one  didn't  work. 

5680  ! 

5690  !  Sesrch  for  confirming  stars. 

5700  ! 

5710  CALL  Dircoih<Bvn<*>, Vn<e),0,T<*>,T<»),T<*>,T<»>> 

5720  MAT  An«Av*v'ri 
5730  Kmaxs^Kmax 
5740  Kmax>0 
5750  MAT  F1d»2E? 

5760  PRINT  US  in:  'V.K";"  Test  For  Additional  Stars" 

5770  PRINT  USIN:  "K";"x<ca1c)  x<meAs>  y<cAlc)  yCmeas)  Dx  By “ 

5780  ! 

5790  FOR  J»l  TO  Mfo<.m 

5800  !  Compete  ffaximum  deviation  allowed  for  each  measured  star. 

5810  Rho»SQR<<Fov»  <  J,  1  )-Xcent  )''2-*-<Fovm<  J,  2>-Ycent  >^2> 

5820  Epsp:J>>1AX<Eps«Rho,2«Sigxy/'F1  > 

5830  NEXT  . 

5840  ! 

5850  FOR  N«1  TO  Nfovc 

5860  FOR  Is»l  TC  3 

5070  L<Is)»’Fovc<N,  Is) 

5880  NEXT  I> 

5890  CAI.L  P-x-egr  <L<*),An<e),Xx<l),Xx<2)) 

5900  FOR  J-1  TO  Nfovm 

5910  Rl»ABS<Xx < 1 )-Fovm< J, 1 )  )  !  Deviation  in  x. 

5920  IF  Ri:Epsp<J)  THEN  Next_j 

5930  R2=ABS<X> <2)-Fovm< J, 2) )  !  Deviation  in  y. 

5940  IF  R2:Epsp<J)  THEN  Next_j 

5950  !  Confirming  star  found. 

5960  PRINT  LSING  "6<MD. DDDD, XX) " ; Xx< 1 ) *F 1 , Fovm( J , 1 ) *F 1 , Xx < 2 ) *F 1 , F ovmC J , 

2)*F1 ,R1#F1 ,R2*F1 

5970  I  PRINT  LSING  "2<MD. DDDD, XX) " ; R1 *F1 , Epsp< J > *F 1 , R2«F 1 , EpspC J ) *F 1 

5980  Kms>:«Kirax'tl 

5990  FI d<Kmex, 1 )>Fovc<N, 1 ) 

6000  F 1  d(  Kmax,  2)>>Fovc  <N,  2) 

6010  FI  Km«.x,  3)*Fovc  <N,  3)  !  Save  data. 

6020  FI  d(  Kme.x,  4)*Fovm<  J,  1 ) 

6030  FI d< Kmax, 5)"Fovm< J, 2) 

6040  ! 

6050  IF  Kmax^Nfovm  THEN  Ho_more  !  We've  matched  all  measured  stars. 

6060  IF  Kma>*5  THEN  No_more  I  We  have  enough  confirming  stars. 

6070  GOTO  N«xt_star 

6080  Next_j:  NEXT  J 

6090  Next  star:  NEXT  N 

6100  "  ! 

6110  No_more :  I-  Kms.x>2  THEN  SUBEXIT 

6120  PRINT  USIN:  "/K";"**  No  additional  stars  found  ♦♦  Assume  false  matck" 
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6130  KfflAX>0 

6140  PRINT  IJSINj  “/'K " ;  "Repl  *c#  n«w  v;a1u*s  of  Eultr  parameters  with  old  w«lues  a 
nd  continue  pairing." 

I  6150  MRT  Bun^Sb  !  Replace  new  Euler  parameters  with  old  walues. 

I  6160  GOTO  Nifxtii  !  Continue  pairing — assume  this  orientation  isn't  correct. 

6170  SUBEND 

I 

^  I 
I 

r 

I 

I 

I 

1 

1 
1 

1 
I 
I 
I 
1 
I 


A 
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Perturb 

This  subroutine  computes  a  time  varying  perturbation  to  Euler 
parameters.  We  have  used  simple  sinusoidal  variations  added  to  the 
nominal  values.  Input  data  consist  of  the  orbital  frequency,  time,  the 
nominal  values  of  the  Euler  parameters  and  the  amplitude  and  frequency 
of  the  variations.  The  perturbed  Euler  parameters  are  returned  to  the 
calling  program. 
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I 

I 

I 

I 

I 

I 

I 

1 


***«*****«**'»««*»  4- **«*«***««*««**»««*•«******«***•***««***««** 


* 

* 

* 


PERTURB 


* 

* 

* 


*««••«**«••«'*  *•«»«•**«  ««««*«»««*««**»«•«*«**«**«*«**«  ******«*«* 


7818  SUB  PeinurstSHCRT  Bnom<*>,E<*>,N<*>,REnL  Omega, Dt , B<«> > 

7820  OPTION  BRS£  1 
7838  I 

7848  B<  1  )-Bnom<  1 :  ■»'£<  1  >*COS<N<  1  >*Omega*Dt  > 

7858  B<2>"Bnom<  2' -•'E<2>»SIN<N<2)*0mcga*Dt  >  <  Perturb  the  nominal 

7868  B<3>>Bnom<  3^  ■t-E<3)*C0S<N<3>e0fflega*Dt  >  I  parameters. 

7870  B<4>aBnom<  M  ■*’E<4>«SIN<N<4)*0mega«Bt  > 

7880  ! 

7898  Nag»SQR<DO Ft B, E > >  !  Normalize  the  new  Euler  parameters. 

7900  MfiT  B-:3/’<Mag) 

7910  I 

7928  SUBEND 


Euler 


This  small  subroutine  uses  the  stellar  colinearity  equations  to 
compute  image  coordinates.  As  input  it  needs  the  star  direction  cosines 
and  the  3  X  3  rotation  matrix.  This  routine  returns  the  x  and  y  coor¬ 
dinates  normalized  by  lens  focal  length: 


X 

Li 

CjJL 

+  L2 

C12 

+  L3 

Cl  3 

f  ~ 

Li 

Cai 

+  L2 

C32 

+  L3 

C33 

Y  _ 

Li 

C21 

+  U 

€2? 

+  L3 

C33 

7  " 

rr 

C31 

+  L2 

C32 

+  L3 

C33 

where  are  elements  of  the  rotation  matrix  and  are  star  direction 
cosines. 


A 
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*«*•«*»«**««>*««»*•**«»*«*«««•*«*««»««**»«****«****««**«******* 
«  « 

*  PHOEQN  * 
«  * 
*•***««*«««*  **«*»«  «*«««««*««««**««••«««***»*•«*«**#«***«***•** 


I 

I 

I 

I 


8170  !  Computes  >;,y  coordinates  for  m  pmrticulmr  star. 

8180  SUB  Phoeqn(L.<*>,C<*>,Xpho, Ypho> 

8190  OPTION  BRSE  1 
8208  BIN  PhoC3> 


8210 


! 


8220  NRT  PhoaC*.  I  Rotate  direction  cosines  into  new  frame. 

8230  Xpho-Pho<l>/-Phc<3> 

8240  Ypho»Pho<2)^Phc<3> 

8250  < 

8260  SUBEND 
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Post-mult 

The  function  of  this  subroutine  is  to  post-multi ply, by  a  rotation 
matrix,  a  set  of  4  matrices  which  are  the  partial  derivatives,  with 
respect  to  Euler  parameters,  of  a  second  rotation  matrix.  For  example, 
for  field  of  view  A  we  need  the  partial  derivatives  of  the  AN  rotation 
matrix  with  respect  to  Subroutine  Mat-av  computes  the  partials 
of  AV  with  respect  to  Then,  since  AN  =  AV  •  VN 

3AN  _  3AV 

•\tk  ~  /\  rt  *  VN 


where  the  partials  indicate  derivatives  of  matrix  elements. 
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**«*««**««««'»•*«  »«'««««*««*«««*«***»**««««*«««««««*•***«******* 
»  * 

*  fOSTMULT  * 

*  ~  * 


11260 

SUB 

Po:tt  m 

11270 

OPTION  BflS 

11280 

DIM 

T<3,3) 

11290 

! 

11300 

MAT 

t«:jci* 

11310 

MAT 

Dc  l-T 

11320 

MAT 

T»;jc2* 

11330 

MAT 

Dc;2-T 

11340 

MAT 

T»;3c3# 

11350 

MAT 

Dc3»T 

11360 

MAT 

T«:3c4» 

11370 

MAT 

Dc4»T 

11380 

! 

11390 

SUBEND 

I  Post -mul  t  <  pi  y  doriwotivs  matrices  by  rotstion  in 


I 


'170 

Pre-mult 

This  subroutine  is  similar  to  Post-mult.  In  this  case,  we  pre¬ 
multiply  partial  derivative  matrices  by  a  rotation  matrix.  For  example, 
since  AN  =  AV  •  VN, 

9AN_  =  AV  . 

3Bvn  ^®VN 

where,  it  will  be  recalled,  the  partial  derivatives  are  computed  by 
Dircosb. 


1 
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*»**«*««««««•*««* 

«  * 


*  PRE_MULT 

*  ~ 


* 

* 


*»«*«***«**« 4**«»««*«***«*«*«*«***««««««*ft**«««ft*«»«*****«**** 


11040 

SUB 

Pnf  mul t  <C<*) 

,Dcl<»),Dc2<*),Dc3<*>,Dc4<*>> 

11050 

OPTION  BPSi  1 

11000 

Din 

T<:3,3) 

11070 

! 

11080 

MAT 

T«i:*Dcl 

11090 

nPT 

Dc  l»T 

11100 

nPT 

T»i:*Dc2 

11110 

MPT 

Dc;>-T  ! 

11120 

MPT 

T«i;»Dc3  ! 

Pr*-mu1 1 1  pi y  derivative  matr 

11130 

MPT 

Dc3»T  1 

11140 

MPT 

T-i:*Dc4 

11150 

MPT 

Dc4*T 

11100 

1 

11170 

SUBENO 

«  rotation  mat 
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Proc-b 


This  subroutine  controls  the  various  functions  of  Process  B. 

As  input  we  need  the  Euler  parameters  describing  the  vehicle  frame 
orientation,  and  those  describing  the  interlock  between  camera 
frames  A  and  B,  along  with  the  variance  to  associate  with  in 
the  Kalman  filter  update.  Usually,  both  sets  of  Euler  parameters  are 
updated  by  Process  B  before  they  are  returned  to  the  calling  program. 
Process  B  also  requires  the  coordinates  of  each  measured  star  in  FOV(A) 
and  FOV(B)  and  returns  the  calculated  coordinates  for  stars  matched  with 
measured  stars. 


The  first  step  in  this  subroutine  is  to  compute  the  rotation 
matrices  BA  from  Bg^.  from  which  we  calculate  AV,  and  matrix  VN  from 
B^Hj.  The  unit  vector  for  the  boresight  of  FOV(A)  is  contained  in  the 
last  row  of  matrix  AN  =  AV  •  VN  and  is  used  by  Access  to  retrieve  a 
subcatalog  of  stars  near  this  boresight.  Pair-it  is  then  called  to 
match  catalog  and  measured  stars  and  to  update  Byj^.  We  then  compute 
VN  again  and  calculate  BN  =  BA  •  AV  •  VN.  The  boresight  unit  vector, 
the  last  row  of  BN,  is  used  by  Access  to  again  obtain  a  sub-catalog. 
Pair- it  once  again  matches  measured  and  catalog  stars  and  updates 

^VN- 

There  are  several  possible  paths  for  Process  B.  If  either  FOV 
contains  fewer  than  three  stars,  we  skip  any  attempt  to  match  stars 
in  the  FOV  (we  need  at  least  three  stars  to  confirm  an  orientation). 
Should  FOV(A)  and  FOV(B)  each  contain  fewer  than  three  stars,  we 
declare  a  failure  condition  for  Process  B  and  return  to  the  calling 
;jroqra«.  In  this  case,  no  attempt  is  made  to  update  By|^  or  Bg^  (and 


no  Kalman  filter  update  is  needed);  the  integrated  values  of  and 
covariance  matrix  are  used  to  start  the  analysis  of  the  next  Process  A 
data  set. 


If  only  one  FOV  contains  a  sufficient  number  of  stars,  we  call 
Least-1  and  use  up  to  5  stars  in  that  FOV  to  update  (Pair-it  updates 
3^1^  using  only  2  stars).  Note  that  the  interlock  parameters,  33^,  are 
not  updated;  the  same  values  are  used  on  the  subsequent  data  frame. 

Usually  there  are  a  sufficient  number  of  stars  in  both  FOV(A)  and 
FOV(B)  (more  than  2  in  each)  so  we  can  correct  both  and  3gy^.  This 
is  done  by  subroutine  Least-2. 

If  3y|^  has  been  updated,  then  we  compute  calculated  image  coordinates 


for  all  matched  stars  and  return  these  to  the  calling  program  along  with 
the  4  X  4  covariance  matrix  associated  with  Bwm. 
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«  * 

*  PROC-B  * 

«  * 

*******«*«««>«•«»«'**«*****«*«*«««**«*****«**«»**«***«»*«****** 

3020  SUB  Pr'jc_b< ♦■2,  £  vn< *  )  ,  Bba< * )  ,  Voc  < * >  ,  Nf  owma,  Nf  owmb ,  Ka,  Kb,  W,  Si  gxy ,  SHORT  X^rna< 

*  > ,  Xy»b<*)  ,  Xyc  a<»i,Xi.cb<#),  RERL  Cov8<*)  ,  Pba<*> ,  Oba<*>  ,  Bba)  sq<*>  > 

3030  I  T.  STRIKUERDR  .  9  JUNE  1980. 

3040  !  This  subor-ogram  is  process  B  oP  Star  Mars.  This  version  uses  Euler 

3050  !  parainete '!•  ard  recovers  interlock  Euler  parameters. 

3060  OPTION  BBS;  1 
3070  Din  Bore<3> 

3080  DIM  Vn:3,3),flv<3,3),Ba<3,3) 

3090  DIM  ftn:3,3>,Bn(3,3>,Bu(3,3),Tn(3,3) 

3100  DIM  Flda<5,5i),Fldb<5,5),Fovm<10,4> 

3110  DIM  Kal<4, 4; ,Lta<4,4),Bbae<4),T3<4),T4<4) 

3120  DIM  Cov<4, 4: 

3130  SHORT  l-ovsl*  106,4) 

3140  COM  Vg;3, 3), INTEGER  Tab1e(529,2> 

3150  RflD 

3160  REDIM  Cov3(8,£> 

3170  ! 

3180  F=?0  !  Some  constants. 

3190  Fes2. 42536 

3200  F1=F>Fe 

3210  Tol=9.25i-6 

3220  Radius*5.7'*PI>^180 

3230  Sigmi=l»»l/l€0 

3240  ! 

3250  !  Calculate  interlock  matrices  BR  and  RV. 

3260  • 

3270  CRLL  Dircosb<Bta<*),Ba<*>,0,Tn<*),Tn<*>,Tn<:*),Tn(*>> 

3280  CRLL  M.it_a j<  Ba<  * )  ,  Tn<* >  ,  Tn< ♦)  ,  Tn< ♦)  ,  Tn<» >  ,  Rv< * >  ,  0,  Tn< ♦  >  ,  Tn< * ) ,  Tn< * >  ,  Tn<  *  >  ) 
3290  Ka»0 
3300  Kb>0 
3310  ! 

3320  PRINT  US  in:  'VK";"  Start  for  F0V<fl)" 

3330  REDIM  Fovmdlfo^.ma,  4) 

3340  IF  NfovmaO  THEN  Fov_b 
3350  FOR  [«1  TO  Nfovma 

3360  Fovm< I , ^ )*>yma< I , 3)  !  Normalize  image  coord,  by  focal  lencth. 

3370  Fovmd,  1  )a>‘yma<I,  1)/F1 

3380  Fovm<I,:;)»><yma<I,2)/FI 

3390  Fovm(  1 , 3)*  l<'S0R<Fovm<  1 ,  1  )^2+Fovm<  I,2>''2+1> 

3400  NEXT  I 

3410  CALL  Dirco5b<B-.n<*>,Vn<»>,0,Tn<*>,Tn<*>,Tn<*>,Tn<*>> 

3420  MAT  Rn»flv*v'ri 
3430  FOR  1*1  ro  3 

3440  Boi"e<  I  )*Rn<3,  I  )  I  Boresight  unit  vector  for  FOVCfl). 

3450  NEXT  I 

3460  PRINT  USIH:  Form5; "Boresi ght  direction  cosines  for  F0V<fl> : “ , Bore<*> 

3470  Forms:  IMR:e;  /K^3<MD.0D0D00,X) 


L 
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3480  CRLL  R>:ces>(#2,Nfo<^ai  Bore<  ,  Si  gma,  Radi  us,  Voc  (*>,Foust<*>> 

3490  CALL  P.iir_it<Fcust<*>,Nfoua, Fovm<*> , Nf ouma, Bun<«>  ,flu<*),To1  ,Sigxv,Fl  ,W,F1d 
a<  *> , Ka> 

3500  Ka2*Ka'»’Ka 

3510  BEEP  !  Dont  with  F0V<R>. 

3520  ! 


.3530  Fou  b:  ! 

3540  PRTnT  US1N3  “xK";"  Start  for  F0V<B>" 

3550  IF  NfoumbO  THEN  Options 
3560  ! 

3570  CRLL  Dircost.<B^.n<*>,Vn<*),0,Tn<*>,Tn<*>,Tn<»>,Tn<*>> 

3580  CALL  Dirco5b<Bta<*>,Ba<*),0,Tn<*),Tn<*>,Tn<*>,Tn<«>> 

3590  MAT  Bv=«Ba*^u 
3600  MAT  Bn:>Bu*«'n 
3610  FOR  1=1  TO  : 

3620  Bore< I i =Br <3, I )  !  Boresight  unit  wactor  for  F0V<B>. 

3630  NEXT  I 

3640  PRINT  tJSIN3  FormS; “Boresight  direction  cosines  for  F0V<B> : " , Bore C*> 

3650  REDin  l-oumCNfotmb,  4> 

3660  ! 

3670  FOR  I»l  TO  Mfotmb 

3680  Fouiii(  1 ,  4^  =X^mb<  1 , 3)  I  Normalize  image  coord,  by  focal  length. 

3690  Fowwd,  i:=Xymb<I,  1)/F1 

3700  Foum< I , =Xy mb< I , 2 >xFl 

3710  Foumd,  3:»l/SQR<Fowm<I,  l>''2+Fovm<I,2>‘'2+l> 

3720  NEXT  I 
3730  ! 

3740  CALL  Ai:ces»<  #2,  Nf oub,  Bore< *) ,  Sigma, Radi  us ,  Voc  <* ) ,  Foust  < *) ) 

3750  CALL  Pair  i t <Fcust <*) , Nf oub, Fowm<*) , Nf ovmb, Bun< *> , Bu< * > , Tol , S i gxy , F 1 , W, F 1 d 
b<*),Kb> 

3760  Kb2=Kb>Kb 
3770  BEEP 
3780  ! 


3790  Options:  I 

3800  IF  <Ka>2)  TND  <Kb>2) 

3810  IF  <Ka:3)  3MD  <Kb<3) 

3820  REDII1  Cov8<4,4) 

3830  IF  <Ka>2)  TUB  <Kb<3) 

onuerge) 

3840  IF  <Ka:3>  4H0  <Kb>2> 
onuerge) 

3850  ! 

3860  GOTO  S.sue  ''(■suits 
3870  ! 


THEN  Combine  !  Do  least-squares  for  two  FOV. 

THEN  Fai led  !  PUNT!  !  ! 

THEN  CALL  Least_l <Bun< * > , Au< *> , F 1 da< » ) , Ka, W, Cot  8 < * > , C 
THEN  CALL  Least  1  CBun<# >  ,  But » >  ,  F 1  db< ♦ ) ,  Kb ,  W ,  Cov  8<.  ♦  > ,  C 


3880  Combine;  I 
3890  I 

3900  MAT  Bb.te«Bo<t  I  Saue  estimated  interlock  parameters. 

3910  CALL  L>rast  2;<  Bent  *  > ,  Bba<  *) ,  Ka,  F 1  da<*  > ,  Kb,  F 1  db(  *  > ,  U,  Cou8< « > ) 

3920  MAT  Bbalsq>l;ba 

3930  !  Perform  Kalman  filter  update  for  interlock  parameters. 

3940  FOR  I- I  TO  < 

3950  FOR  .1=1  TO  4 

3960  Lbatl,  J:-Ccu8<4->1,4-»J) 

3970  NEXT  J 

3980  NEXT  I 
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3990 
4000 
4010 
4020 
4030 
4040 
4050 
4060 
4070 
4080 
4090 
4100 
4110 
4120 
4130 
4140 
)  ) 

4150 

4160 

4170 

4180 

4190 

4200 

4210 

4220 

4230 

4240 

4250 

4260 

4270 

4280 

4290 

4300 

4310 

4320 

4330 

4340 

4350 

4360 

4370 

4380 

4390 

4400 

4410 

4420 

4430 

4440 

4450 

4460 

4470 

4480 

4490 

4500 

4510 

4520 

4530 


! 


MAT 

Pba*’ba+Gba 

1  Get  covariance 

matrix  at 

this  time. 

MAT 

MAT 

l<al  =  .ba'*'Fba 
Lba-INV<Kal > 

MAT 

MAT 

Kal =^baeLba 
r3=B3ii-Btae 

1  Kalman  gain 

matr i x. 

MAT 

MAT 

T4=Ka1*T:- 

3ba=6bae'»T4 

!  Corrections 

to 

interlock 

parameters. 

MAT 

MAT 

Lba=  <«il  *F  ba 
l>ba=^ba-Lba 

!  Corrections 

to 

covar i ance 

matr i x. 

S*v«_r*:Jul  t  »;  ! 

CALL  Di  r:c.sb<Bwn<«),  Vn<*),0,  Tn<#> ,  Tn<* ) ,  Tn<« > ,  Tn<»> > 

CALL  Di  r  :c>sb<BbA<*)  ,B*<»),0,Tn<*),Tn<*>,Tn<»>,Tn<»>> 

CALL  Mat  _aw<ia<»),Tn<*),Tn<*),Tn<»),Tn<*>,Av<*>,0,TnC*),Tn<#),Tn<:«),  Tn<« 

MAT  rtn»Aj*Vn 
MAT  Xs'casJIER 
IF  Ki»0  THEN  Saw€_b 
!  “ 

FOR  K=»l  TO  !  Calculate  image  coord,  for  each 

FOR  I>t  TO  3  I  matched  star. 

aoreCl )=F)da<K, 1> 

NEXT  I 

CALL  P'loeqr  <Bore<#),An<*),X,Y) 

Xy:  aCK,  1  Jal- 
Xy:a<K,;:)*V 
NEXT  K 

MAT  Xvca«>;yc«.*<Fn 
Sauc  b:  ! 

MAT  :Jn*Ba^An 
MAT  Xycb»i;ER 
IF  Kb’<0  THEN  End 

I 

FOR  l(»l  TO  Kt 
FOR  1=1  TO  3 

:3ore<l)=Fldb<K,I) 

NEXT  I 

CALL  Pioeqr <Bore<*),Bn<»),X, Y) 

XycbCK,  J  )■>• 

Xy.;b<K,;;)=Y 
NEXT  K 

MAT  Xycb«>:ycb*<Fl ) 

! 

Forml:  IMA:e:  K/'4<MD.  DDDDDE,  X)/ 

Form4:  IMAit.  K,  X,  DD.'10<2<MD.  DDDD,  X)^ > 

End:  ) 

SUBEXIT 

! 

Failed:  PRINT  “♦*»##«#»#  PROCESS  B  FAILED  *########»»»»»#»" 

PRINT  "Fewer  than  3  stars  in  each  FOV.  No  attempt  to  perform  " 
PRINT  "  1  east -squares  correction.  Use  old  values  for  ori  enie.t  i  on.  " 
GOTO  Save  results 

SUIEND 


I 


The  subroutine  integrates  both  the  state  differential  equations  and 
the  matrix  Riccati  equation,  using  Runge-Kutta  methods.  As  discussed 
in  Appendix  8,  we  partition  the  Riccati  equation  into  four  parts  and 
only  two  of  these  need  to  be  integrated  numerically. 

Both  of  the  equations  are  integrated  with  two-cycle  Runge-Kutta 
methods.  However,  since  the  covariance  matrix  should  be  relatively 
constant  in  steady-state,  we  use  a  step  size,  for  the  Riccati  equation, 
equal  to  the  time  between  data  frames  (currently,  30  seconds).  The  step 
size  for  the  state  integration  is  much  smaller  (currently,  0.5  sec  or 
60  steps  between  frames). 

The  first  task  in  this  subroutine  is  to  partition  the  covariance 
matrix  and  evaluate  the  right-hand-side  of  the  Riccati  equation  at  the 
start  of  the  time  interval.  We  then  integrate  the  state  equation, 
through  repeated  use  of  two-cycle  Runge-Kutta  methods,  until  we  reach 
the  end  of  the  interval.  The  right-hand-side  of  the  Riccati  equation  is 
again  evaluated,  this  time  at  the  end  of  the  interval,  and  the  integrated 
covariance  matrix  calculated. 
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*•*«*«««*««*'*«««»«•«*«««««««««««««*«*«««*««**•«*****«****«*»•** 

*  * 

«  R  U  N  C  E  * 

»  * 

«««*******«*■»««*»*'«*««*«*«*•*«»««*«*«****«««««*»*«*******«**** 

13600  SUB  Ruiige<ri>  ,  Of  It,  Step,  SHORT  Ml  <*> ,  M2<  *> ,  M3(  *> ,  REAL  Xk  <  *>  ,  P(  *> ,  Q(  *>  ,  S  i  gb> 
13610  OPTION  BRSE  1 

13620  DIM  X<4>,Pll<4,4),P21<3,4>,Pllp<4,4>,P21p<3,4>,P22<3,3> 

13630  DIM  Di;4>,<l<4,4>,Ll(3,4>,Sumk<4,4>,Sum1(3,4> 

13640  DIM  SI :4>, ^1 1<4,4>,A12(4,3>,M<3>,B(3> 

13650  DIM  Q2:><3,  3:  ,P22p<3,3> 

13660  ! 

13670  MRT  Q2:>sID'l 

13680  MRT  022^02 2*-< <S  i gb^30>''2>  !  Factor  of  30  may  be  changed  to  tune  Kalman 

13690  !  filter  for  bias  recover. 

13700  DISP  “Rungt' 

13710  ! 

13720  T»Tk 

13730  FOR  I>1  TO  <■ 

13740  FOR  .1*1  TCI  4 

13750  PI  1 < 1 , *P< I ,  J)  I  Get  upper  left  4x4  portion  of  cov,  matrix. 

13760  NEXT  J 
13770  NEXT  I 
13780  ! 

13790  FOR  I»l  TO  3 
13800  FOR  1*1  TCI  4 

13810  P2 I < I , J' ■P(4+I , J>  I  Get  lower  left  3x4  portion  of  cov.  matrix. 

13820  NEXT  J 
13830  NEXT  I 
13840  ! 

13850  FOR  I- I  TO  3 

13860  B<  I  >:«Xk  <  4-1 1  >  I  Get  current  bias  values. 

13870  FOR  J-1  TCI  3 

13880  P2;2<  I ,  J' ■P<4+1 , 4+J)  !  Get  lower  right  3x3  portion  of  cow.  matrix. 

13890  NEXT  J 
13900  NEXT  I 
13910  ! 

13920  REDIM  ;<<4>,>;k(4> 

13930  MRT  X-:<k 
13940  MRT  PI lp«Pll 
13950  MRT  P2lp»P21 
13960  MRT  P2:>p-P22; 

13970  !  Conputf  time  derivative  of  covariance  matrix  at  time  tCinitial). 

13980  M<1>«HU1> 

13990  M<2>*M:2<1)  !  Use  gyro  rates  from  beginning  of  interval. 

14000  M<3>-U3<1> 

14010  • 

14020  CRLL  Mata<l,M<«>,Xk<*),Rll<«>,R12C*>> 

14030  CRLL  D.friw<Pll|:<»>,P21p<#),P22p<*>,0<*),Rll<»>,R12(e),Kl<*>,Ll<*>> 

14040  • 

14050  MRT  Suwk-Kl 
14060  MRT  Sum 1 -LI 


14070  MfiT  fll  l»Kl»<St6p) 

14080  MAT  PI  lp«Pn+flll 
14090  MAT  A1 t«Ll»(Stcp> 

14100  MAT  P2lp«P21-t-All 
14110  REOIM  All<4,4> 

14120  MAT  P2;>p*Q22»<Step) 

14130  MAT  P2;2p»>P2;:+P22p 
14140  ! 

14150  !  Bcjin  integr&tton. 

14160  ! 

14170  MAT  U*H-B  I  Subtract  bias  values. 

14180  CALL  MataO,M<«>,X<«>,All<*>,A12<«>> 

14190  I 

14280  FOR  It-»2  TD  Stcp/De1t«l  !  This  is  a  series  of  2  -  step  Runge-Kutta 
14210  MAT  ;jl«All«Xk  !  integrations. 

14220  MAT  :>1>><D«  1  t)«Dl 
14230  MAT  X-XkfSl 

14240  W<l>>Ul(It) 

14250  M<2>  :M2< It )  !  Get  gyro  rates  for  interval. 

14260  W<3>:*M3<It)  !  Note;  These  are  measured  rates  in  gyro  fretne 

14270  MAT  M=M-B  !  Subtract  the  biases. 

14280  CALL  Mata<0,K«),X<#),All<»>,A12<*>> 

14290  MAT  !51««A11#X 

14300  MAT  :<»D1*£;1 

14310  MAT  :<■<.  3t  0e]t>*X 
14320  MAT  :<k-X<-»X 

14330  DISP  xk<»;; 

14340  Tk«Tk*Delt 

14350  NEXT  1" 

14360  ! 

14370  Mag"SQR<00r( Xk , Xk ) >  I  Normalize  Euler  parameters. 

14380  MAT  Xk=«Xk/(Mag> 

14390  !  CoTtputf  time  derivative  of  covariance  matrix  at  time  t  (final). 

14400  M<l)«iUl(61) 

14410  U<2)-M2(61> 

14420  U(3>-U)<61) 

14430  ! 

14440  CALL  Mita(l,W<«),Xk<*),All<*),A12<»>) 

14450  CALL  D.»riv<Pllp<*>,P2lp<«>,P22p<«>,Q(#>, A11<*>,A12<#>,K1<*),L1<*>> 
14460  ! 

14470  !  Conpute  updated  covariance  matrix. 

14480  ! 

14490  MAT  SuMk«S jmk-t-k  1  (  Compute  upper-left  4x4  matrix. 

14500  MAT  Sumkt<Sj«ik*<Stcp^2> 

14510  MAT  PI  l«Pl  l+Suirk 

14520  MAT  SuMl>Sum1^Ll  I  Compute  lower-left  3x4  matrix. 

14530  MAT  Suml>Sjml*(Step/2) 

14540  MAT  P2l«P2HSuffl 
14550  NAT  P2.2p-Q22*(Step> 

14560  MAT  P2;2>P22-)P22p 

14570  I  Fill  tke  upper  left  4x4  of  the  covariance  matrix. 

14580  FOR  Iml  TO  *■ 

14590  FOR  .J>1  rci  4 
14600  P((. J>«P11(1,J> 

14610  NEXT  J 
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14620  NEXT  1 

14630  I  Fin  the  lower  left  3x4  pert  of  cowerlence  motrix 

14640  I  A'tcl  the  upper  4x3  pert  with  the  transpose. 

14690  FOR  I«l  TO  3 

14660  FOR  J-l  TCI  4 

14670  P<4*1, J:»P21<I, J> 

14680  P(J,44-i:-PSl<I,  J> 

14690  NEXT  J 

14700  NEXT  I 

14710  FOR  I- I  TO  3 

14720  FOR  J*1  T3  3 

14730  P<4«[,4  +  J>P22<I,  J> 

14740  NEXT  .1 
14780  NEXT  I 
14760  I 

14770  REDIM  ;<k<7) 

14780  ! 

14790  DISP 
14800  SUBEND 


[ 
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Secant 


Subroutine  Secant  uses  the  secant  method  to  update  the  parti  cal 

derivative  matrix  used  for  least-squares  correction  (containing  the 

derivatives  of  image  coordinates  with  respect  to  the  Euler  parameters, 

8).  If  we  let  X  =  X(8)  be  the  set  of  function  {colinearity  equations) 

which  produce  image  coordinates  for  stars  as  a  function  of  Euler  para- 

k  k 

meters,  then  at  the  kth  iteration  we  have  3  »  the  coordinates  X  ,  and 

the  partial  derivative  matrix  A  =  3X/93l|^  (determined  by  Dxdbeta ) . 

k  k+l  k  k 

By  least-squares  we  obtain  corrections  to  3  to  get  3  =  3  +  A3  . 

k+1 

These  are  used  to  compute  new  coordinate  X  so  the  changes  are 
6X*^  =  -  X*^. 

However,  the  linearly  predicted  changes  in  X  are 

Av^  -  /ik  /lok 

AX  =  A  AS  . 

We  proceed  to  modify  the  derivative  matrix  (be  adding  corrections)  so 
that  the  linearly  predicted  changes  will  agree  with  the  actual  changes: 

AX*^  =  (A*^  +  c'^)A3'^. 

No  unique  solution  to  this  equation  exists  so  we  introduce 

L 

((>  =  i:i(C..  )^  and  minimize  this  criterion  subject  to 
ij  '' 

SX*^  -  A*^  AS*^  -  C*^  AS*^  =  0. 

Using  the  Lagrange  multiplier  technique  we  minimize 

$  =  Z  E(C..'‘)^  +  A^(6X'^  -  A*^  AS*^  -  AS*^). 

i  j 

The  necessary  conditions  require 
=  0 

*  M 
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9$/3X^  =  0 
or 

k  1  k 

and 

-  a'^  Aa*^  -  c*^  =  0. 

Matrix  C  can  be  expressed  as  the  outer  product  of  two  vectors: 

C*'  =  ]■  X(Aa'^)^. 

We  can  now  substitute  for  matrix  C  in  the  second  necessary  condition 
and  solve  this  equation  for  the  Lagrange  multipliers: 

X  =  2(6X'^  -  A6'^)/(Aa'^)^  AB*^ 

and  substitute  this  for  X  in  the  first  necessary  condition.  Thus,  the 
updated  partial  derivative  matrix  is 

=  a*^  +  (BX*^  -  a'^ab'^)(ab'^)^/{ab'^)^  ab*^  . 

The  secant  method  works  best  when  we  are  near  the  solution  vector, 
AB.  As  a  check  on  the  performance  of  this  method,  we  compute  the  root- 
mean-square  difference  between  calculated  and  measured  coordinates  at 
each  iteration.  If  this  parameter  ever  increases  from  its  last  value, 
we  start  over  with  exact  derivatives  (computed  by  Dxdbeta)  before 
continuing  with  the  least-square  correction. 
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««*«»*•**«**'(*»*  »*■**«  »**«*««**«««*••**»«*«««»«**«««******«**«« 
*  * 

♦  SECANT  * 

«  * 

«««*****««««■»***»«■**«*«*******«******•«*«**««««****«***«««**** 


78150 

7860 

7870 

7880 

7890 

7900 

7910 

7920 

7930 

7940 

7950 

7960 

7970 

7980 

7990 

8000 

8010 

8020 

8030 

8040 

8050 

8060 

8070 

8080 


I  Secant  methoc  of  derioatioe  update. 

SUB  Secant (N<e>,De1x<e), Ddy(*> » Idi m, Jdi m> 

OPTION  BAS-  1 

Bin  T1  Cl,JdiM>,T2(Idim,  l>,T3<Idtm,JdiM>,  Sumat  (  Id  t  ro) 
! 


DISP 


“Secant  " 

! 


Sumt2s:}0T(D(  lx.DeIx) 

MAT  Sumat > 4*'De  1  y 
MAT  SumatsOdy-Sumat 
MAT  SuMat3«3umat/'<Sumt2> 
! 

FOR  I=l  TO  Idiff 
T2<I . l)=3umat<I) 

NEXT  I 

FOR  J*l  TO  :ditf 
T1<1 , J)«0« ly<J) 

NEXT  J 


I  Predicted  changes  in  coordinates, 
f  Difference  between  actual  and  predicted 
<  changes. 

•  Fill  vectors  for  outer  product. 

!  <see  Appendix  of  Final  Report.) 


MAT  T3-T2*n 
MAT  A«IHT3 


!  Compute  corrections  to  derivatives. 
!  Add  corrections. 


DISP 

SUBENO 
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Sort 

This  subroutine  sorts  an  array  and  a  column  vector  according  to 
the  values  in  the  column  vector.  The  order  of  sorting  is  from  the 
largest  to  the  smallest  values  and  the  array  and  vector  must  have  the 
same  number  of  rows.  We  use  a  simple  "bubble"  sort  method  -  make  repeated 
searches  through  the  list,  each  time  bringing  the  next  largest  value  to 
the  next  available  location  in  the  list.  In  this  version,  in  order  to 
save  computer  time,  we  use  a  vector  to  save  the  re-ordering  sequence 
of  the  column  vector  and  use  this  sequence  to  re-order  the  array  as  the 
last  step. 


*******««»**'»**«»««*«**«««««««««»*««««*«*«««»«*»«*«««*«**«*•*« 
»  * 


♦  SORT 

« 


* 

* 


*****************  *«***«*«****««****«»*«««««««**«  «*««*««**« 


9730 

!  This  sub^ciutin® 

sorts  arrays  by  rows,  given  a  parameter  vector  of 

9740 

!  s«me  dim?MSicn 

as  the  number  of  rows. 

9750 

SUB  Soi't<fi<*>, SHORT  B<*),REflL  N,M> 

9760 

OPTION  BRSE  1 

9770 

DIM  C<H>,S<M,I1> 

9780 

! 

9790 

DISP  "Sort" 

9800 

! 

9810 

FOR  K=l  TO  N 

9820 

C<K)=*K 

!  Fill  index  vector. 

9830 

NEXT  K 

9840 

N1.«N-1 

9850 

j 

9860 

FOR  K»l  TO  HI 

1  Bubble  sort  —  bring  largest  value  to  top. 

9870 

Jj=K 

9880 

Test  *fi<K> 

9890 

K1=K>1 

9900 

FOR  I=K1  TO  F 

9910 

IF  Test;fl<n 

THEN  Continue  !  Search  for  largest  value. 

9920 

J  j  *I 

9930 

Tt:lt»fl<  1  ) 

9940  Continu*?:  NEXT  1 

9950 

IF  J.i»K  THEN  Conti rue2 

9960 

fl<Jj 

9970 

fl<K)  «Tesi 

!  Place  next  largest  value  in  next  location. 

9980 

T»C<K) 

9990 

C<K) «C<Jj: 

1  Switch  indices  as  well. 

10000 

C<Jj  )-T 

10010 

Continije2:  4£:XT  K 

10020 

! 

10030 

FOR  I»l  TO  N 

10040 

K*C< [) 

10050 

FOR  l.-l  TO  M 

10060 

S<  I,L)al!<K,L) 

!  Reorder  array  in  same  order--refer  to  index  vector. 

10070 

NEXT  L 

10080 

NEXT  I 

10090 

! 

10100 

MRT  B-S 

10110 

1 

10120 

DISP 

10130 

SUBEND 

AO-A103  806  VIRGINIA  POLYTECHNIC  INST  AND  STATE  UNIV  BLACKSBURG  —ETC  F/6  17/7 
STAR  PATTERN  RECOGNITION  AND  SPACECRAFT  ATTITUDE  DETERMINATION. {U) 
MAY  81  T  £  STRIKWERDA*  J  L  JUNKINS  DAAK70-7e-C-003e 

UNCLASSIFIED  ETl-0260  NL 


10-81 


n 
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Sample  output  from  data  generator  program  (DATGEN): 
Program  setup,  data  for  frame  2  and  beginning  of  frame  3. 


PROCRflM  DflTGEN 

Do  you  w«nt  ‘;o  u»<'  r«*H Stic  gyro  r*t«  history  (Y/'N>?  Y 

Pise*  disk  with  gyro  rstss  <P1 1  ensue: ^Utrus' >  In  :F8,1 . then  push  CONT. 

Piece  star  c-stalsg  disk  <F11enames:  'TAb2Z'  and  ^M1ss220'>  In  :F8,1... 

...then  push  CONF. 

Has  Table  of  sta'^  catalog  cell  positions  been  read-1  n?(Y^N>  N 

File  name  for  sinulation  run  ( 'SI  mnnn:  F8, 1 where  nnn  Is  3  nuMi>: 
SlNie42:F8,l 

Period  :  '>0.03  mirutes 

Do  you  want  uariatlors  in  Euler  para,  relating  V  frame  to  Gyro  frame  (Y^'N)'?  Y 

Do  you  want  uariatlors  In  Euler  para,  relating  B  frame  to  R  frame  <Y/N>?  V 

Do  you  want  itme  (.‘arylng  gyro  biases  (Y/H)?  Y 

Do  you  want  ".o  add  ncl  se  to  Image  coordi  nates(Y/’N>?Y 

Do  you  want  nois?  adeed  to  rate  gyro  data  <Y/N>?Y 
Position  <km)  and  velocity  <km/'sec>  of  Satellite: 

S.6526E-^03  0.030OE-»00  0.Oe0eE-^00 

0.0e00E4-e0  2.e3::4E40e  7.4?68Ei-e8 

Matrix  GM: 

8.800000  .258319  .965928 

0.000000  -.965326  .258819 

1 . 000000  0 . 000  300  0 . 000000 

Bug. . . nomi nal  Euler  Parameters  between  frames  V-G: 

1.800000  0.000300  0.000000  0.000000 

Bug... true  Euler  Parameters  between  frames  V-G: 

1.000000  0.000300  .000015  0.000000 

Bun. . . Ini t 1 al  Euler  Parameters  between  frames  V-N: 

.092295  .7013<-7  .092297  .701068 


e*********  FRRME  :  2  *««*«***«** 

Matrix  VG: 

1.000000  0.000300  -.000029 

0.000000  1.000300  0.000000 

.000029  0.000300  1.000000 

Satellite  time  f^'Cim  start  of  simulation:  38.00  seconds 

Bun... True  Euler  Parameters  between  frames  V-N: 

.090640  .688306  .093727  .713240 

Bba. .. Nomi nal  Euler  Parameters  between  frames  B-R: 

.707107  .707107  0.000000  0.000000 

Bba. ..True  Euler  Parameters  between  frames  B-R: 

.707131  .707303  .000097  0.000000 


MMMMiiiiiiiiik 
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Matrix  BR  : 

i.eeeeee  .eeei::?  -.000137 

.000137  .0003<:9  1.000000 
.000137-1.000300  .000069 

Position  <kM>  *nd  «^«1oc1ty  <kM.^s*c>  of  Satelllt* 
6.6485E4-03  6.0390E401  2.2426E-^02 

-2.7014E-01  2.0322E-»00  7.4723E-i>00 

Position  (kM>  «nd  <^«1oc1ty  (km/stc)  of  E^rth: 
-1.4960E408  8.13<3E-»02  -3.5630E4'02 

1.7790E-04  2.7314E401  -1.1877E+01 

Total  velocity  of  satolllt*  <kM/'s*c>: 

-2.6997E-01  2.9317E401  -4.4043E-»'00 


Matrix  RN: 


.999384 

.008706 

.033971 

.025019 

.500303 

-.865442 

-.024602 

.8657;i9 

.499855 

Bores  1 ght 

unit  utctor 

e 

a 

-.024602 

.865759 

.499855 

Polar  angle:  63.01 

Longitude 

angle:  91 

.63 

Indices  for  'our  cells: 

16  16 

1»  i* 

8  9 

»  0 

Number  of 

stars  from 

the  cat  a 

Number  of 

stars  In  tkls  FOV: 

True  Image 

coordinates  (mm): 

5. 128090 

2.681 SO0 

4.503000 

4.462200 

3. 126300 

4.509000 

2.580310 

2.440900 

4.810000 

.891715 

.633400 

3.244000 

-1.584060 

.529  3M 

2.990000 

5.024780 

-2.588370 

3.085000 

-.543383 

-3.457300 

4. 166000 

-.950058 

-4. 1777C.0 

4.574000 

-4.615360 

-3.573700 

4.966000 

-4.840800 

-1 . 151500 

4.936000 

Measured  Image  coordinates  <mi 

5. 125990 

2.680390 

4.523250 

4.458730 

3.124900 

4.560540 

2.581860 

2.440350 

4.862560 

.896847 

.637305 

3.259580 

-1.582270 

.524318 

2.987110 

5.018640 

-2.5874<0 

2.961420 

-.547052 

-3.453350 

4. 174510 

-.953583 

-4.175710 

4.633090 

-4.610930 

-3.573390 

4.875600 

-4.840900 

-1 . 151770 

4.929290 

Matrix  RN: 

.999391 

.008706 

.033784 

-.024464 

.865795 

.499801 

-.024884 

-.500323 

.865481 

Boresight 

unit  utctor 

• 

• 

-.024884 

-.500323 

.865481 

14.00 


10.00 


Polar  angl* 


33.06 
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Longitudt  «ng1t:  267.15 
Indicts  for  *our  ctlls: 

8  8  6  6 

13  12  ID  <• 


Number  of 

stars  from 

the  catalog: 

9.00 

Number  of 

stars  in  this  FOV:  5. 

00 

True  image 

coordinates  (mm): 

.438158 

-3.896320 

2.313000 

2.604860 

-3.363190 

4.900000 

5.575850 

-1.474120 

4.835000 

-3.296900 

-2.229360 

4.825000 

-1.927940 

2.696350 

4.342000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0 . 000000 

0.000300 

0. 000000 

Measured  image  coordinates  (mm>: 

.437323 

-3.897300 

2.321970 

2.603590 

-3.365270 

4.866520 

5.579470 

-1.471 220 

4.821620 

-3.305680 

-2.229210 

4.858870 

-1.928110 

2. 694140 

4.363480 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

Bi ases. . . true  values 

e 

a 

-.000007 

.000310 

-.000015 

Frame:  2 

Number  of 

stars:  10  5 

**«««****« 

FRRME  :  3 

«*»***«**•« 

Matrix  VG: 

1.000000 

.000308 

-.000029 

-.000008 

1 .000300 

-.000003 

.000029 

.000303 

1.000000 

Sat  el  1 i te 

time  f-cm 

start  of  simulation: 

Bvn. . . True 

Euler  F'ar 

ameters  between 

frames 

V- 

.089034 

.676167 

.095378  .725102 

Bba. . . Noroi nal  Euler 

Parameters  between  frames 

.707107 

.707107 

0.000000  0.000000 

Bba. . .True 

Euler  Parameters  between 

frames 

B-l 

.707139 

.707375 

.000095  .000003 

Matrix  BR 

a 

a 

1.000000 

.00014-0 

-.000130 

.000130 

.000300 

1.000000 

.800140 

-1 .000300 

.000090 

Position  (km)  snd  velocity  (km^stc)  of  Smttllitt: 

6.6364E483  1.231  lE->02  4.4825E>e2 

-5.3996E-ei  1.93ti5E-»ee  7.4586E-»ee 

Position  <km>  snd  velocity  (km/'sec)  of  Emrth: 
-1.496eE^e8  1.63(196403  -7. 1260E4-02 

3.5881E-04  2.7314E401  -1.1877E401 

Total  velocity  of  satellite  (km/sec): 

-5.3960E-01  2.93J3E401  -4.4180E4Oe 
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Sample  output  from  data  analysis  program  (COMBIN): 

Program  setup  and  beginning  of  frame  2. 

PROCESS  B  RND  C  #«##«##«••«#«» 

Doing  Proc  B  V 

Doing  Proc  C  V 

Insort  star  catalog  cisk  into  F8,i....Thon  press  CONT 
Has  cell  table  b»(n  read-in?  N 

Input  file  name  and  ceuice  with  simulation  data:  Sime42:F8,l 

Satellite  orbit  najor  axis  <km>:  SS53 

Earth  orbit  majo'  axis  <km>:  1.49S0E+88 

Satellite  orbit  inclination  <deg.>:  75 

Rate  gyro  da; a  soacirg  <sec>:  .50 

Runge-Kutta  ';ime  <.te|;  <sec>:  30.00 

Gyro  standard  de.*iation  <rad/’sec>:  4.848E-06 

Input  weight  in  arcseconds  for  interlock  uariance  <2,5|etc.>  5.000 

Input  Gyro  B i as  Stancard  Deuiation  <Degrees/Hr>  .50 
Q  Matrix: 

2,350E-U  0.03(iE-^60  0.0e0E-t00 

0.000E-tO0  2.330E-11  e.000E't00 

0.0e0E-t0e  0.030E-»’E0  2.350E-11 

Do  you  want  "o  offset  matrix  VG  <V-frame  to  Gyro  frame)  N 

Matrix  VG  for  this-  rcn: 

i.0eoE-t00  0.03(iE+e0  0.0O0Et-0e 

e.000E-tee  i.03(iE-te0  0.0e0E+00 

o.oeeE-t00  0.03(iE-t€0  i.e00E-t00 

RECORD  HUMEER 

Bun....  True  l-ule^  parameters  between  V  and  N  frames: 

.090671  .683716  .093893  .713186 

Bba.  ...True  Eule-'  parameters  between  B  and  A  frames: 

.707131  .707(183  .000097  0.000000 

Bba. ...  Current  E.iler  parameters  between  B  and  R  frames: 

.707131  .707083  .000097  0.000000 

Components  o'  total  <^elocity  <km>'sec>: 

-2.700E-01  2.93;:E+ei  -4.404E+00 

Number  of  stars  in  each  FOV: 

F0V(A>:  10 
F0V<B>:  5 

Bun. ...  Integrated  Euler  parameters  between  V  and  N  frames 
and  gyro  bia:»es: 

.089241  .676321  .095545  .725192 

O.OO0E^OO  0.003006  O.OOOE+OO 

Components  o'  total  velocity  <km/sec>: 

-2.70eE-01  2.93S;E-tei  -4.404E<»O0 


Sample  output  from  data  analysis  program  (CONBIN) 
Analysis  of  data  from  frame  5. 


record  HUHtER;  3 

Bvn....Tru*  l£ult'  pAra«tt«rs  between  V  and  N  frames: 
.083633  .653^46  .898389  .748233 

Bba.  ...True  llule"  parameters  between  B  and  8  frames: 
.787153  .787861  .888884  .888818 

Bba. ...  Current  Ejler  parameters  between  B  and  8  frames: 
.787146  .787867  .888899  -.888888 

Components  o'  total  velocity  (km.'sec): 

-1.877E-*^88  2.938E'i-El  -4.473E«88 

Number  of  stars  in  each  FOV: 

F0V<8):  8 

F0V<B>:  6 

Bun. ...  Integrated  Euler  parameters  between  V  and  N  frames 
and  gyro  bia:ses: 

.885786  .658376  .898562  .748299 

-5.633E-86  4.482£>ee  -1.359E-85 

Components  o'  total  velocity  <km.^sec>t 
-l.877E*8a  2.938E+C1  -4.473E+88 


Start  for  F0V<fi) 

Boresight  direction  cosines  for  F0V<R): 
-.898483  .864385  .493232 

Polar  angle:  68. o  Degrees 
Longitude  angle:  96.5  Degrees 

Cel  I  indices: 

16  16  14  14 

9  8  8  7 


Table  of  CosCTheta)  for  Measured  Stars. 
Star  Star  Cos<Theta> 

1  2  .93<82; 

1  3  .93:!78€ 

1  4  .937851 

2  3  .939822 

1  5  .937526 

2  4  .938894 

1  6  .938722 

2  5  .935755 

3  4  .938641 

1  7  .938682 

2  6  .937735 

3  5  .935966 

1  8  .938382 

2  7  .938821 

3  6  .937476 

4  5  .938695 

2  8  .938996 
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3  7  .93776€ 

4  6  .99T‘697 

3  8  .9  9(1535 

4  7  .99739; 

5  6  .999438 

5  7  .999348 

5  8  .99£i42? 

6  8  .99774; 

7  8  .99744; 

Begin  Pairing  C«lji1o;  Stars  and  Comparing  To  Measured  Pairs 

Number  of  stars  from  catalog:  IS 
Star  Star  Cos<Theta> 

1  2  .999998 

1  3  .99801; 

>>>>>  Catalog  Pair  Matched  with  Measured  Pair  <<<<< 

Measured  pair: 

Star  Star  Cosdheta) 

7  2  .998021 

Least -Squares  Correction  For  One  FOV 

RMS  error  for  no^'Aialized  image  coordi nates:  1 . 6748E-04 

BetaCoid)  !:eta.<new>  Oeita<Beta> 

.0857057  .08;2774  -.0004283 

.6503783  .6589618  .0005855 

.0985616  .0989390  .0003773 

.7482986  .7477891  -.0005095 

RMS  change  in  Eu1«r  parameters:  4.8172E-04 

RMS  error  for  normalized  image  coordinates: 2. 31 34E-05 

Beta<o1d)  BeteCnew)  0e1ta<Beta> 

.0852774  .08;2771  -.0000003 

.6509618  .6589621  .0000003 

.0989390  .0989394  .0000004 

.7477891  .7477882  -.0000009 

RMS  change  in  Euler  parameters:  5.4913E-07 
Number  of  iterations:  2  Converge*! 


Test  I'or  Additional  Stars 


x<ca1  c  > 

x(meas) 

V<cal  c ) 

y<meas  > 

Dx 

Dy 

.3588 

.3567 

-1.1708 

-1.1696 

.0021 

.0012 

.6301 

•  6335 

-1.3228 

-1.3184 

.0034 

.0044 

-3.6080 

-3. 6060 

1.0902 

1.0890 

.0021 

.0012 

3.7541 

3.^560 

.5865 

.5992 

.0019 

.0128 

1.0280 

1.0338 

-3.7184 

-3.7160 

.0058 

.0024 

Start  for  F0V<|i> 

Boresight  direction  cosines  for  F0V<B>: 
-.096652  -.501S63  .859646 

Polar  angle:  30.7  Degrees 
Longitude  angle:  259.1  Degrees 

Cell  indices; 

0  8  6  6 

12  13  9  10 
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T«b)*  of  CosCTh*tit>  for  Measured  Stars. 

Star  Star  Cos < Theta) 

1  2  .99::8ei 

1  3  .99f:75€ 

1  4  .9)163S 

2  3  .99759€ 

1  5  .9?;:97S 

2  4  .997e4€ 

1  6  .93307S 

2  5  .99275€ 

3  4  .99f:69€ 

2  6  .99]64€ 

3  5  .997282 

3  6  .99892; 

4  5  .997517 

4  6  .998411 

5  6  .99534; 

Begin  Pairing  Catalog  Stars  and  Comparing  To  Measured  Pairs. 

Number  of  stars  from  catalog:  16 
Star  Star  Cos<Theta> 

1  2  .996682 

1  3  .99751; 

>>>>>  Catalog  Pair  Matched  with  Measured  Pair  <<<<< 

Measured  pair: 

Star  Star  Cos < Theta) 

5  4  .997517 

Least -Squares  Correction  For  One  FQV 

RMS  error  for  normalized  image  coordinates: 1.2863E-03 

Beta<o1d)  BetaCneu)  De1ta<Beta> 

.0852771  .08;3e85  .0000315 

.6509621  .65ei618  -.0008003 

.0989394  .09E8372  -.0001022 

.7477882  .74E4948  .0007066 

RMS  change  in  Euler  (carameters:  5.3647E-04 

RMS  error  for  normalized  image  coordinatcs:9.5265E-06 

Beta<o1d)  l!et3.<neu)  De1ta<Beta) 

.0853085  .08;3081  -.0000004 

.6501618  .65E1616  -.0000002 

.0988372  .09E8367  -.0000004 

.7484948  .74E4943  -.0000005 

RMS  change  in  EuUr  |:arameters:  3.9327E-07 
Number  of  iterations:  2  Converge* 1 


Test  l-or  Tclditional  Stars 


K(ca1c  > 

x<meas) 

y<ca1c) 

y<meas> 

Dx 

By 

1 . 8908 

1.8912 

-2. 1949 

-2. 1940 

.0003 

.0009 

-1.7222 

-1.  M92 

2.4753 

2.4632 

.0031 

.0121 

3.6270 

3.6267 

2.6151 

2.6141 

.0003 

.0009 

-3.6754 

-3.6810 

-2. 1516 

-2. 1678 

.0056 

.0162 

-4.7927 

-4.  »999 

4.4085 

4.3959 

.0071 

.0126 

Least-Squares  Correction  For  Two  FQV 
Correct  orientation  tsing  5  stars  from  F0V<fl>  and  5  stars  from  FOV(B). 


s 


*-■  *  •  H;  >  gr 


.  *•  •»~iF  **•• 
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RMS  error  in  noritiillzed  imege  coordinatce:  5.7645E-04 


Euler  pA'^hmeters 
delt  a-  B<V-N> 


B<V-N> 

0856257 

6504280 

0985211 

7482684 


03031 ?5 
0  3()26€4 
03(i3i;6 
03022:9 


And  corrections: 

del t A-B<B-fi> 


B<B-fl> 

7071793 

7070343 

0000228 

0001544 


0000330 

0000329 

0001221 

0001542 


RMS  chAnge  in  Euler  pArAtneters:  2.1310E-O4 


RMS  error  in  nornAlized  imege  coordinAtes:  4.8614E-05 


Euler  pA‘'Atneters 


B<V-N)  del  t  A- B<'*-N) 
.0856257  .0300Oei 

.6504279  -.03000ei 

.0985212  .03000€1 

.7482683  -.03000^1 


and  corrections: 

delt a-B<B-8> 


BCB-R) 

7071792 

7070344 

0000227 

0001544 


0000002 

0000002 

0000000 

0000000 


RMS  chAnge  in  Euler  parAweters:  1.0901E-07 


RMS  error  in  nornAli7ed  i niAge  coordinAtes:  4.8614E-05 


Euler  pA^iimeters 
B<V-N)  delta-B<'»-N> 
.0856257  .03000€0 

.6504279  .03000C0 

.0935212  .03000Ce 

.7482683  -.0380060 


And  corrections: 


B<B-fl> 

.7071792 

.7070344 

-.0000227 

-.0001544 


del t A-B<B-fl> 
-.0000000 
,0000000 
. 0000000 
.0000000 


RMS  change  in  Euler  parameters:  7.6322E-09 
(End  of  1 e< St -squares  for  two  F0V> 


Kalman  File <r  State  Estimation 


True 

8.563E-02 

6.504E-01 

9.851E-02 

7.483E-01 

-7.062E-06 

7.796E-06 

-1.725E-05 


_ S  t  «tt  e 

Int«  g. 
8.571E -02 
i;.504E:-01 
9.  855E:-02 
^483E;-01 
!5.63  3E:-0€ 
4.482E:-0€ 
i.353e;-0: 


ec  t  or s _ 

Proc .  B 
8.563E-02 
6.504E-01 
9.852E-02 
7.483E-01 
-5.633E-06 
4.482E-06 
-1.359E-05 


Opt.  Est. 
8.564E-02 
6.504E-01 
9.853E-02 
7.483E-01 
-6.234E-06 
5.567E-06 
-1.556E-05 


<  I-T) 
7.280E-05 
-7.019E-05 
5.228E-05 
4.579E-05 
1.430E-06 
-3.314E-06 
3.656E-06 


Biff  erence 
(B-T> 

-7. 171E-06 
-1.861E-05 
1. 184E-05 
1.544E-05 
1.430E-06 
-3. 314E-06 
3.656E-06 


<0-T) 

5. 125E-06 
-2.872E-05 
1 . 64  IE- 05 
2.231E-05 
8.284E-07 
-2. 23OE-06 
1 .685E-06 


Norm  of  optimal  fstinrate  -  1:  .00000007 


(end  of  fre.me) 


